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Abstract 


Title  of  Dissertation:  Control  and  Stabilization  of  a  Class  of 

Nonlinear  Systems  with  Symmetry 


Vikram  Manikonda,  Doctor  of  Philosophy,  1998 


Dissertation  directed  by:  Professor  P.S.  Krishnaprasad 

Department  of  Electrical  Engineering 


The  focus  of  this  dissertation  is  to  study  issues  related  to  controllability  and 
stabilization  of  a  class  of  underactuated  mechanical  systems  with  symmetry. 
In  particular  we  look  at  systems  whose  configuration  can  be  identified  with  a 
Lie  group  and  the  reduced  equations  are  of  the  Lie-Poisson  type.  Examples  of 
such  systems  include  hovercraft,  spacecraft  and  autonomous  underwater  vehi¬ 
cles.  We  present  sufficient  conditions  for  the  controllability  of  affine  nonlinear 
control  systems  where  the  drift  vector  field  is  a  Lie-Poisson  reduced  Hamilto¬ 
nian  vector  field.  In  this  setting  we  show  that  depending  on  the  existence  of  a 
radially  unbounded  Lyapunov  type  function,  the  drift  vector  field  of  the  reduced 
system  is  weakly  positively  Poisson  stable.  The  weak  positive  Poisson  stability 


along  with  the  Lie  algebra  rank  condition  is  used  to  show  controllability.  These 
controllability  results  are  then  extended  to  the  unreduced  dynamics.  Sufficient 
conditions  for  controllability  are  presented  in  both  cases  where  the  symmetry 
group  is  compact  and  noncompact. 

We  also  present  a  constructive  approach  to  design  feedback  laws  to  stabilize 
relative  equilibria  of  these  systems.  The  approach  is  based  on  the  observation 
that,  under  certain  hypotheses  the  fixed  points  of  the  Lie- Poisson  dynamics 
belong  to  a  locally  immersed  equilibrium  submanifold.  The  existence  of  such 
equilibrium  manifolds,  along  with  the  center  manifold  theory  is  used  to  design 
stabilizing  feedback  laws. 
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Chapter  1 


Introduction 


In  the  middle  of  the  19th  century  Sophius  Lie  made  a  far  reaching  discovery  that 
techniques  designed  to  solve  particular  unrelated  types  of  ordinary  differential 
equations  (ODE’s),  such  as  separable,  homogeneous  and  exact  equations,  were 
in  fact  all  special  cases  of  a  general  form  of  integration  procedure  based  on  the 
invariance  of  the  differential  equation  under  a  continuous  group  of  symmetries. 
Roughly  speaking  a  symmetry  group  of  a  system  of  differential  equations  is 
a  group  that  transforms  solutions  of  the  system  to  other  solutions.  Once  the 
symmetry  group  has  been  identified  a  number  of  techniques  to  solve  and  classify 
these  differential  equations  becomes  possible.  In  the  classical  framework  of  Lie, 
these  groups  were  local  groups  and  arose  locally  as  groups  of  transformations  on 
some  Euclidean  space.  The  passage  from  the  local  Lie  group  to  the  present  day 
definition  using  manifolds  was  accomplished  by  Cartan. 

These  continuous  groups,  which  originally  appeared  as  symmetry  groups  of  dif¬ 
ferential  equations,  have  over  the  years  had  a  profound  impact  on  diverse  ar¬ 
eas  such  as  algebraic  topology,  differential  geometry,  numerical  analysis,  control 
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theory,  classical  mechanics,  quantum  mechanics  etc.  They  are  now  universally 
known  as  Lie  groups. 

One  of  the  main  foci  of  this  dissertation  is  to  model  and  study  a  class  of  controlled 
mechanical  systems,  whose  configuration  space  can  be  identified  with  a  finite  di¬ 
mensional  Lie  group,  and  whose  dynamics  can  be  modeled  as  Euler-Lagrange  or 
Hamiltonian  dynamics.  Examples  of  such  systems  include  hovercraft,  spacecraft 
and  underwater  vehicles  modeled  as  rigid  bodies.  To  model  the  dynamics  of 
these  mechanical  systems  we  adopt  the  Hamiltonian  formulation.  Rather  than 
adopt  the  canonical  Hamiltonian  or  Euler  Lagrange  formulation  on  a  Euclidean 
space,  in  this  dissertation,  instead  we  adopt  a  more  general  differential  geomet¬ 
ric  approach  to  mechanics.  We  use  a  non-canonical  Hamiltonian  formulation, 
modeling  these  systems  on  Poisson  manifolds  and  using  the  associated  Poisson 
structure  to  write  down  the  Hamiltonian  dynamics. 

Hamiltonian  mechanics  and  its  relation  to  the  concept  of  Poisson  manifolds  has 
its  origins  in  the  original  work  of  Poisson,  Hamilton,  Liouville  and  others.  The 
more  general  notion  of  a  Poisson  structure  apparently  first  appears  in  Lie’s  theory 
of  “function  groups” .  It  was  later  rediscovered  many  times  under  different  names 
in  the  works  of  Lie,  Dirac,  Pauli,  Martin,  Sudarshan  and  Mukunda,  Hermann, 
and  others.  A  geometric  approach  to  the  study  of  mechanical  systems  has  had  a 
profound  influence  in  the  qualitative  analysis  of  dynamics  of  mechanical  systems. 
Playing  an  essential  role  in  this  are  recent  developments  in  reduction  theory 
which  draws  its  inspiration  from  Lie’s  original  work  (cf.  [Marsden  and  Ratiu, 
1994],  for  further  details).  Some  of  the  reduction  techniques  developed  include 
Lagrangian  reduction  [Marsden  and  Scheurle,  1993a;  R.Yang  et  al,  1993]  which 
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involves  dropping  the  Euler-Lagrange  equations  to  the  quotient  of  the  velocity 
phase  space  by  the  symmetry  group.  Hamiltonian  reduction,  on  the  other  hand, 
involves  projecting  the  Poisson  bracket  to  the  reduced  (quotient)  space  which 
also  inherits  a  Poisson  structure.  In  particular,  if  the  configuration  space  of 
the  system  can  be  identified  with  a  Lie  group  G.  a  left  invariant  Hamiltonian 
on  T*G  gives  rise  to  reduced  dynamics  on  T*G/G,  which  is  isomorphic  to  g* 
the  dual  of  the  Lie  algebra  of  G.  The  Poisson  structure  on  g*  is  attributed 
to  Lie  and  Berezin-Kirillov-Kostant-Souriau.  (See  the  work  of  Weinstein  for 
historical  remarks  [Weinstein,  1983a]).  Apparently  Lie  was  also  aware  of  the 
Poisson  structure  on  the  dual  of  a  Lie  algebra,  but  it  was  only  recently  that  it 
became  clear  that  this  bracket  is  obtained  by  a  simple  reduction  procedure  i.e. 
it  is  induced  from  the  canonical  bracket  on  T*G  by  passing  to  T*G/G  which  is 
isomorphic  to  g*.  This  bracket  associated  with  the  dual  of  the  Lie  algebra  is  now 
universally  known  the  Lie- Poisson  bracket. 

Using  this  differential  geometric  approach  to  mechanics,  in  Chapter  2  we  derive 
the  reduced  dynamics  of  hovercraft,  spacecraft,  underwater  vehicles  and  surface 
vehicles.  In  each  case  we  identify  the  configuration  space  with  a  Lie  group,  iden¬ 
tify  the  symmetry  group  of  the  dynamics,  and  write  down  the  reduced  dynamics 
on  the  reduced  phase  space  in  terms  of  the  Poisson  structure  associated  with 
the  reduced  phase  space.  The  examples  discussed  in  Chapter  2  are  of  practical 
interest.  For  example  the  amphibious  versatility  of  hovercraft  has  given  them  a 
role  in  specialized  applications  including  search  and  rescue,  emergency  medical 
services,  ice  breaking,  Arctic  off-shore  exploration,  and  recreational  activities 
[Amyot,  1989].  Certain  environmental  aspects  (such  as  ice-roughness,  Arctic 
rubble  fields  etc.)  also  provide  a  niche  for  operations  by  hovercraft.  Similarly  a 


3 


growing  industry  in  underwater  vehicles  for  deep  sea  explorations  has  lead  to  the 
demand  for  more  versatile,  robust  and  high  performance  autonomous  vehicles 
that  can  cope  with  actuator  failures,  disturbances,  exploit  sensor  based  local 
navigation  etc.  The  design  and  control  of  autonomous  versions  of  these  vehicles 
has  also  been  of  much  recent  interest. 

Given  a  particular  input  to  the  actuator  the  approach  adopted  to  write  down 
the  dynamics  plays  a  crucial  role  in  providing  an  insight  into  the  controllability 
and  stability  properties  of  the  dynamics  of  these  systems.  As  we  see  in  Chapter 
4  and  Chapter  5  the  geometric  approach  to  modeling  these  systems  has  many 
advantages  over  conventional  approaches  especially  in  providing  insight  into  con¬ 
trollability  and  stability  properties  of  these  systems.  The  hovercraft  is  modeled 
as  a  planar  rigid  body  subject  to  an  external  force.  Its  configuration  space  is  iden¬ 
tified  with  the  Lie  group  SE( 2),  and  the  reduced  dynamics  are  written  on  se( 2)*. 
The  configuration  space  of  the  underwater  vehicle  and  surface  vehicle  is  identified 
with  the  Lie  group  SE(3).  The  underwater  vehicle  is  modeled  as  a  completely 
submerged  body,  in  an  inviscid,  incompressible  and  irrotational  fluid  of  infinite 
volume.  The  study  of  completely  submerged  bodies  in  ideal  fluids  has  a  long  his¬ 
tory  dating  back  to  the  classic  work  of  Kirchhoff,  Lamb  and  Birkhoff  [Lamb,  1945; 
Birkhoff,  I960].  More  recently  in  [Leonard,  1995]  the  equations  are  derived  in 
the  geometric  framework.  We  also  study  the  motions  of  floating  bodies  (e.g. 
ships)  in  quiet  water  without  the  consideration  of  resistance  forces.  While  ship 
motions  arise  very  rarely  in  quiet  water,  there  is  a  great  practical  value  in  their 
study  since  the  characteristics  of  ships  in  agitated  seas  are  governed  by  the  char¬ 
acteristics  of  motion  in  quiet  water.  Unlike  the  case  of  the  completely  submerged 
vehicle,  in  the  case  of  a  tossing  vessel  as  a  result  of  the  change  in  the  shape  of 
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the  submerged  volume  the  force  due  to  buoyancy  changes  its  magnitude,  and 
point  of  application.  In  each  of  the  cases  we  identify  the  symmetry  groups  and 
write  down  the  reduced  dynamics  on  the  reduced  spaces. 

The  impact  of  Lie  theory  in  control  theory  in  the  context  of  nonlinear  control 
became  prominent  around  the  early  1970.  The  fundamental  observation  that 
almost  all  the  information  in  the  Lie  group  is  contained  in  its  Lie  algebra,  and 
questions  about  systems  evolving  on  Lie  groups  could  be  reduced  to  their  Lie 
algebras,  is  the  cornerstone  of  the  applications  of  Lie  algebras  and  Lie  groups 
to  control  theory.  In  the  early  1970’s  Brockett,  Jurdjevic,  Sussmann  and  others 
exploited  this  observation  and  introduced  the  theory  of  Lie  groups  and  their  as¬ 
sociated  Lie  algebras  into  the  context  of  nonlinear  control  to  express  notions  such 
as  controllability,  observability  and  realization  theory  for  right- invariant  systems. 
One  of  the  most  notable  application  of  Lie-theoretic  techniques  in  control  theory 
has  been  in  determining  controllability  of  nonlinear  systems.  Results  in  this  area 
have  inspired  many  interesting  approaches  in  the  designing  constructive  control 
laws  to  steer  and  stabilize  nonlinear  control  systems. 

Some  of  the  early  work  [Lee  and  Markus,  1976]  (and  references  therein)  on  non¬ 
linear  controllability  was  based  on  linearization  of  nonlinear  systems.  It  was 
observed  that  if  the  linearization  of  a  nonlinear  system  at  an  equilibrium  point 
is  controllable,  the  the  system  itself  is  locally  controllable.  Later  a  differential 
geometric  approach  to  the  problem  was  adopted  in  which  a  control  system  was 
viewed  as  a  family  of  vector  fields.  It  was  observed  that  (c.f.  [Hermann,  1968; 
Hermann  and  Krener,  1977;  Hermes,  1974;  Krener,  1974;  Sussmann  and  Jurd¬ 
jevic,  1972;  Lobry,  1970]))  a  lot  of  the  interesting  control  theoretic  information 
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was  contained  in  the  Lie  brackets  of  these  vector  fields.  It  was  realized  [Hermann 
and  Krener,  1977;  Krener,  1974]  that  Chow’s  theorem  [Hermann,  1968]  lead  to 
the  characterization  of  controllability  for  systems  without  drift.  Chow’s  theorem 
provides  a  Lie  algebra  rank  test,  for  controllability  of  nonlinear  systems  without 
drift,  similar  in  spirit  to  that  of  Kalman’s  rank  condition  test  for  linear  systems. 
In  the  setting  of  controlled  mechanical  systems  while  drift  free  dynamics  arise 
when  one  writes  down  the  kinematics,  once  dynamics  are  included  the  system 
is  no  longer  drift-free.  Chow’s  theorem  can  no  longer  be  used  to  conclude  con¬ 
trollability.  Studying  controllability  of  systems  of  general  systems  with  drift  is 
usually  a  hard  problem.  Important  contributions  in  this  direction  have  been  due 
to  Bonnard,  Lobry,  Crouch,  Byrnes,  Jurdjevic  and  Kupka  [Jurdjevic  and  Kupka, 
1981],  and  others.  In  [Crouch  and  Byrnes,  1986]  sufficient  conditions  are  given, 
in  terms  of  a  “group  action” ,  that  a  locally  accessible  system  is  also  locally  reach¬ 
able.  In  [Lobry,  1974]  sufficient  conditions  for  the  controllability  of  a  conservative 
dynamical  polysystem  on  a  compact  Riemannian  manifold  are  presented.  More 
recently  this  result  was  extended  by  [Lian  et  al,  1994]  to  dynamical  polysystems 
where  the  drift  vector  held  was  required  to  be  weakly  positively  Poisson  stable. 

A  main  contribution  of  this  dissertation  is  discussing  controllability  of  under 
actuated  mechanical  systems  with  symmetry.  In  this  Chapter  4  we  present  suf¬ 
ficient  conditions  (Theorem  4.2.2)  for  controllability  of  affine  nonlinear  control 
systems  where  the  drift  vector  held  is  a  Lie-Poisson  reduced  Hamiltonian  vec¬ 
tor  held.  We  show  that  depending  on  the  existence  of  a  radially  unbounded 
Lyapunov  function,  the  drift  vector  held  (of  the  reduced  system)  is  weakly  pos¬ 
itively  Poisson  stable.  The  Weak  Positive  Poisson  stability  of  the  drift  vector 
held  along  with  the  Lie  algebra  rank  condition  [Lian  et  al,  1994]  is  used  to  show 
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controllability  of  the  reduced  system. 


Having  shown  controllability  of  the  reduced  dynamics  we  then  present  sufficient 
conditions  for  controllability  of  the  unreduced  dynamics  depending  on  whether 
the  symmetry  group  is  compact  or  noncompact.  In  the  setting  where  the  sym¬ 
metry  group  is  compact  we  show  that  under  assumptions  of  Theorem  4.2.2,  we 
can  conclude  that  the  drift  vector  held  on  T*G  is  also  weakly  Positively  Poisson 
stable.  This  again  enables  us  to  conclude  controllability  on  T*G.  In  the  setting 
where  the  symmetry  group  is  noncompact,  we  show  (Theorem  4.4.17)  that  we 
can  conclude  controllability  of  the  unreduced  dynamics.  The  proof  relies  on  that 
of  Theorem  4.2.2.  and  earlier  work  by  Murray  and  Lewis  [Lewis  and  Murray, 
1996]  on  configuration  controllability.  Our  result  gives  a  manageable  tool  to 
check  for  controllability  of  a  wide  class  of  mechanical  systems  with  symmetry. 
These  results  are  then  applied  to  the  examples  discussed  in  chapter  3,  in  each 
case  drawing  conclusions  on  the  controllability  of  the  dynamics.  Some  other 
results  in  this  chapter  are  on  small  time  local  controllability  of  these  systems. 

In  Chapter  5  we  study  stability  and  feedback  stabilization  of  mechanical  system 
with  symmetry.  We  focus  our  attention  of  stability  on  fixed  points  of  the  reduced 
dynamics.  These  give  rise  to  relative  equilibria,  i.e.  trajectories  that  are  group 
orbits  in  the  unreduced  phase  space.  While  one  can  ascertain  in  a  straightfor¬ 
ward  manner  spectral  stability  of  Hamiltonian  systems,  concluding  nonlinear  or 
Lyapunov  stability  is  more  difficult  as  the  linearization  of  a  stable  Hamiltonian 
dynamics  has  eigenvalues  on  the  imaginary  axis.  For  canonical  Hamiltonian  sys¬ 
tems  the  Lagrange  Dirichlet  criterion  provides  sufficient  conditions  for  stability. 
This  result  was  extended  by  Arnold  [Arnold,  1969],  as  the  method  now  known 
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as  the  energy- Casimir  method  [Bloch  et  ai,  1992a;  Bloch  and  Marsden,  1990; 
Krishnaprasad  and  Marsden,  87].  In  Chapter  5  we  study  the  stability  of  the 
fixed  points  of  the  reduced  dynamics  using  the  energy  Casimir  method.  We 
identify  the  unstable  relative  equilibria  for  the  example  systems  discussed  in 
Chapter  3.  Having  identified  the  unstable  equilibria  the  main  focus  of  the  rest 
of  the  chapter  is  in  constructing  linear  dissipative  feedback  laws  to  stabilize  the 
unstable  equilibria.  We  present  a  general  approach  (Theorem  5.3.5),  based  on 
center  manifold  theory,  to  construct  stabilizing  feedback  laws  to  stabilize  relative 
equilibria  of  mechanical  systems  with  symmetry.  The  approach  is  based  on  the 
observation  that,  under  certain  hypotheses,  the  fixed  points  of  the  Lie- Poison 
reduced  dynamics  can  be  shown  to  belong  to  a  locally  immersed  equilibrium 
manifold.  The  existence  of  this  equilibrium  manifold  is  used  to  construct  stable 
center  manifolds.  Some  other  results  in  this  chapter  include  a  discussion  and 
some  results  on  Hamiltonian  feedback  laws  to  stabilize  relative  equilibria  of  the 
example  systems. 

In  Chapter  6  we  summarize  the  contributions  of  this  dissertation  and  present 
some  future  topics  for  research.  We  also  discuss  some  conjectures  on  the  existence 
of  discontinuous  feedback  laws  to  stabilize  the  origin  of  the  reduced  dynamics. 


Chapter  2 


Preliminaries 


In  this  chapter  we  review  some  basic  definitions,  notations  and  important  the¬ 
orems  in  differential  geometry  and  geometric  mechanics.  Mathematical  tools, 
concepts  and  results  that  will  be  used  frequently  in  the  following  chapters  are 
collected  together  in  this  chapter.  As  one  of  our  main  goals  we  outline  the 
process  of  reduction  of  nonlinear  control  systems  with  symmetry.  In  particular 
we  consider  the  case  when  the  “free  dynamics”  are  derived  from  a  Hamiltonian 
that  is  invariant  under  the  action  of  a  Lie  group  G.  The  reduction  procedure 
plays  a  key  role  in  deriving  the  reduced  dynamics,  controllability  results  and 
constructive  control  laws  for  a  large  class  of  mechanical  systems  discussed  in 
later  chapters. 
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2.1  Differential  Geometry  and  Geometric  Me¬ 


chanics 

As  mathematical  tools  and  theorems  from  geometric  mechanics  and  differential 
geometry  will  play  an  important  role  in  the  discussions  that  follow  in  the  later 
chapters,  in  this  section  we  introduce  some  relevant  definitions  and  theorems. 
[Abraham  and  Marsden,  1977;  Marsden  and  Ratiu,  1994;  Marsden,  1992;  Olver, 
1993;  Arnold,  1989;  Crampin  and  Pirani,  1986;  Nomizu,  1956]  will  serve  as  our 
main  sources  of  reference. 


2.1.1  Lie  Groups  and  Group  Actions 

A  Lie  group  G  is  a  manifold  G  that  has  a  group  structure  consistent  with  its 
manifold  structure,  i.e.  the  group  operations  :  product  and  inverse,  are  differen¬ 
tiable  maps.  The  maps  Rg  :  G  — »  G;  h  (->•  hg,  and  Lg  :  G  G]  h  ^  gh,  g,h  G  G 
are  called  the  right  and  left  translation  maps. 

A  Lie  algebra  is  a  vector  space  V  together  with  an  operation  [•,•]:  V  x  V  — )■  V 
called  the  Lie  bracket  for  V,  satisfying 

(i)  Bilinearity 

[cv  +  cV,  re]  =  c[v,  w]  +  d\v,  w\,  c,c'  G  R 


(ii)  Skew-Symmetry 


V,  w]  =  —[w,v 
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(iii)  Jacobi  Identity 


[u,  [ v ,  w]\  +  [w,  [u,  v]]  +  [u,  [w, «]]  =  0 

V  u,  v,  v',  w  G  V. 

A  vector  field  X  on  G  is  called  left  invariant  if  for  every  g  G  G 

L*gX  =  X  i.e.  ( ThLg)X(h )  =  X(gh),  \/h  e  G  (2.1) 

where  7),  ( • )  is  derivative  of  the  map  Lg. 

Given  an  element  £  G  TrG.  the  tangent  space  at  the  identity  of  G.  a  left  invariant 
vector  held  JQ  on  G  is  dehned  as  X^(g)  =  TeLg(£).  Dehning  the  Lie  bracket  on 
TeG  as 

K,*7]  :=  [X£,x„](e), 

TeG  forms  a  Lie  algebra  which  is  isomorphic  to  the  set  of  left  invariant  vector 
fields  on  G.  The  vector  space  TeG  with  its  Lie  algebra  structure  is  called  the  Lie 
algebra  of  G  and  is  denoted  by  g.  Its  dual  space  is  denoted  by  g*. 

Let  M  be  a  smooth  manifold.  A  left  action  of  a  Lie  group  G  on  M  is  a  smooth 
mapping  $  :  G  x  M  — *  M  such  that 

(i)  <3>(e,  x)  =  x 

(ii)  $(g,  x))  =  $(gh,  x)  \/g,  h,  e  G,x  e  M. 

For  every  g  G  G  let  <3>g  :  M  — »  M  be  given  by  <&(g,x).  At  various  times  it  will 
be  useful  to  hold  one  variable  fixed  and  consider  the  action  $  as  a  function  of 
the  remaining  variable.  Hence  :  M  — »  M  denotes  the  map  x  (l>(g.  x)  and 
&x  :  G  — >  M  denotes  the  map  g  <F(p,  x).  In  the  special  case  where  M  is  a 
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Banach  space  V  and  each  :  V  — »  V  is  a  continuous  linear  transformation,  the 
action  $  of  G  is  called  a  representation  of  G  on  V. 

The  orbit  of  re  G  M  under  the  action  $  is  defined  by 

Orb(x)  =  {<l>9(x)  |  g  G  G}  C  M. 

In  finite  dimensions  Orb(x)  is  an  immersed  submanifold  of  M.  An  action  <3> 
of  G  on  a  manifold  M  defines  an  equivalence  relation  on  M,  by  the  relation 
of  belonging  to  the  same  orbit.  Let  M/G  (also  called  the  orbit  space )  denotes 
the  set  of  equivalence  classes,  it  :  M  — *  M/G  :  x  (->•  Orb(x);  then  the  quotient 
topology  on  M/G  is  given  by  defining  U  C  M/G  to  be  open  if  and  only  if  7r_1(t/) 
is  open. 

An  action  $  :  GxM  — »  M  is  said  to  be  free  if  it  has  no  fixed  points,  i.e.  $9(x)  =  x 
implies  that  g  =  e  or,  equivalently,  if  for  each  x  G  M,  g  H-  $9(x)  is  one-to-one. 
An  action  $  :  G  x  M  — >  M  is  proper  if  the  mapping  (j)  :  G  x  M  — *  M  x  M, 
defined  by  &(g,  x)  =  (x,  &(g,x))  is  proper.  (See  also  Section  4.4) 

Remark  2.1.1  In  finite  dimensions  properness  means  that  if  K  C  M  x  M  is 
compact,  then  (j)~l{K)  is  compact.  In  general,  this  means  that  if  {xn)  is  a  con¬ 
vergent  sequence  in  M  and  if  4>gnxn  converges  in  M,  then  {gn}  has  a  convergent 
subsequence  in  G.  If  G  is  compact,  properness  is  automatically  satisfied. 

Proposition  2.1.2  J/$:CxMqM  is  a  proper  and  free  action,  then  M/G 
is  a  smooth  manifold  and  n  :  M  — >•  M/G  is  a  smooth  submersion. 

Proof:  See  [Abraham  and  Marsden,  1977]  Proposition  4.1.23,  page  266.  ■ 
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Of  particular  interest  to  us  are  the  adjoint  and  the  coadjoint  actions  of  G  on  g 
and  g*  respectively,  and  the  induced  action  of  G  on  the  tangent  bundle  TM  and 
the  cotangent  bundle  T*M  of  M.  The  adjoint  action ,  denoted  by  Ad,  of  G  on 
its  Lie  algebra  g  is  given  by 

Ad  :  G  x  g  — >  g,  Adg(tj)  =  Te(Rg- 1  o  Lg)£,  g  G  G,  £  G  g.  (2.2) 

Let  Ad*  :  g*  — »  g*  be  the  dual  of  Adg  dehned  by 

(Ad* a,  £)  =<a,Adgi> ,  a  G  g*,  ^g, 

where  <  >  denoted  the  natural  pairing  between  g  and  g*.  The  coadjoint 

action  of  G  on  g*  is  dehned  by 

Ad*  :  G  x  g*  4  g*;  (g,  a)  i-G  Ad*g-ia.  (2.3) 

The  tangent  lift,  denoted  by  <f>T,  of  the  action  of  G  on  TM  is  given  by 

$t:GxTM4TM:  (g,  vq)  T$g  ■  vq  (2.4) 

where  vq  G  TqM. 

The  cotangent  lift,  denoted  by  $T*,  is  given  by 

T*$  :  G  x  T*M  :  (g,  aq)  i-G  T*$g-iaq,  (2.5) 

where  aq  G  T*M  and  T*$s-i  is  the  dual  of  Tq$g-i 

Given  an  action  $  :  G  x  M  — *  M,  for  each  (  G  g,  the  map  :  R  x  M  — »  M, 
dehned  by  &(t,x)  =  $(exp t£,x),  is  an  IR-action  on  M.  The  corresponding 
vector  held  on  M  given  by 
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£m(x)  |t=o  $exp^(£), 

is  called  the  infinitesimal  generator  of  the  action  corresponding  to  £. 


(2.6) 


2.1.2  Hamiltonian  Systems 

Though,  in  this  dissertation  we  mainly  concern  ourselves  with  Hamiltonian  sys¬ 
tem  on  Poisson  manifolds,  understanding  the  symplectic  foliations  of  Poisson 
manifolds  plays  a  key  role  in  some  of  our  proofs  in  later  chapters.  Hence  we 
start  with  a  description  of  Hamiltonian  systems  on  symplectic  manifolds  and 
then  proceed  to  a  description  on  Poisson  manifolds. 

A  symplectic  manifold  is  a  pair  (P,  12)  where  P  is  an  even-dimensional  manifold 
and  12  is  a  closed  non- degenerate  two-form  on  P. 

A  vector  held  X  on  P  is  called  a  Hamiltonian  vector  field,  if  there  exists  a 
function  H  :  P  — >  H  called  the  Hamiltonian,  such  that 

ixS2  =  dH  nz(X(z),v)  =  dH(z).v  z,v  E  P,  (2.7) 

where  ix  is  the  interior  product  and  d!2  is  the  exterior  derivative  of  12.  (cf.  [Mars- 
den  and  Ratiu,  1994]).  A  Hamiltonian  vector  held  is  denoted  by  X h-  If  such  a 
function  is  dehned  on  a  neighborhood,  we  say  X  is  locally  Hamiltonian. 

Given  a  manifold  M  the  cotangent  bundle  T*M  has  a  natural  symplectic  struc¬ 
ture.  When  M  is  the  configuration  space  of  a  mechanical  system,  T*M  is  called 
the  momentum  phase  space.  Choosing  (q1, . . .  qn )  as  local  coordinates  for  M,  and 
(dq1, . . .  dqn )  as  a  basis  for  TfM,  a  G  TfM  can  then  be  written  as  a  =  Pidq1. 
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Hence  (q1, . . .  qn ,p\, . . . pn )  are  local  coordinates  on  T*M.  With  respect  to  these 
local  coordinates  the  symplectic  form 

n 

^0  =  5^  dql  A  dP” 

i= 1 

dehnes  a  two  form  on  T*M  and  is  called  the  canonical  symplectic  form  on  T*M. 

Let  (j)  :  M  — y  N  be  a  C°°  map  from  the  manifold  M  to  the  manifold  N,  given  a 
fc-form  a  on  N,  the  pull  back ,  f>*a,  of  a  by  (j)  is  the  fc-form  on  M  given  by 

((j)*a)q(v  =  a^q){Tq<f>-vu...Tq<f>-vm),  (2.8) 

where  vi,...Vk  €  TqM. 

Given  two  symplectic  manifolds  (Pi,  ffi)  and  (P2)^2),  a  C,00-mapping  (f>  :  P1  — y 
P2  is  called  symplectic  or  canonical  if 

cj)*n2  =  fii  (2.9) 

Proposition  2.1.3  Let  <f>t  denote  the  flow  of  a  vector  field  X .  Then  <f>t  consists 
of  symplectic  transformations  (  i.e.  for  each  t,  (fflVL  —  Q  )  if  and  only  if  X  is 
locally  Hamiltonian. 

Proof:  See  [Marsden  and  Ratin,  1994]  Proposition  5.4.2,  page  141.  ■ 

An  n-dimensional  manifold  M  is  said  to  be  orientable  if  there  is  a  nonvanishing  re¬ 
form  //  called  a  volume  form  defined  on  it.  A  2n-dimensional  symplectic  manifold 
is  oriented  by  the  Liouville  volume  S  which  in  local  coordinates  has  the  expression 

H  =  dq1  A  •  •  •  A  dqn  A  dpi  A  •  •  •  dpn. 
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(P,  S)  is  called  a  volume  manifold  and  the  measure  associated  with  5  is  called 
the  Liouville  measure. 


The  divergence  of  a  vector  held  X  relative  to  a  volume  form  /j,  denoted  by 
divM(X),  is  given  by 

=  divflX)^  where  Cx H  =  U=o  • 


The  how  (J)t  of  X  is  said  to  be  volume-preserving  if 


divM(X)  =  0.  (2.10) 

Hence  it  follows  that 


div^X)  =  0  iff  flp  =  p.  (2.11) 


Proposition  2.1.4  The  flow  ft  of  a  Hamiltonian  vector  field  Xh  defined  on  a 
symplectic  manifold  (P,  fl)  is  volume  preserving  and  is  a  local  diffeomorphism. 

Proof:  The  proof  follows  from  Proposition  2.1.3  and  Equation  2.11.  ■ 

We  now  consider  Hamiltonian  systems  on  Poisson  manifolds.  A  Poisson  manifold 
is  a  pair  (P,  {•,  •})  where  P  is  a  smooth  manifold  and  {•,  •}  :  C°°(P)  x  C°°(P)  — )■ 
C°°(P)  is  a  map  called  the  Poisson  bracket  which  satishes 

(i)  Bilinearity 

{cF  +  c'F,  G}  =  c{F,  G}  +  c'{F,  G},  c,  c'  e  R 

(ii)  Skew  symmetry 

{F,G}  =  -{G,F} 
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(iii)  Jacobi  Identity 


{{F  G},  P)  +  {{P,  F},  G}  +  {{G,  P},  F}  =  0 

(iv)  Leibniz  Rule 

{F,  G.P }  =  {F,  G}  ■  P  +  G  ■  {F,  P},  G,F,P  e  C°°(P), 

where  •  denotes  the  ordinary  multiplication  of  smooth  real  valued  functions  on  P. 
Observe  that  C°°(P )  forms  a  Lie  algebra  under  the  Poisson  bracket.  A  Poisson 
structure  can  be  uniquely  expressed  through  a  contravariant  skew-symmetric 
two-tensor  A,  called  (cf.  [Marsden  and  Ratiu,  1994])  the  Poisson  tensor  such 
that 

{F,  G}(z)  =  A(z)(dF(z),  d G(z))  Vz  G  P.  (2.12) 

Given  a  smooth  function  H  :  P  — >  1R  dehned  on  a  Poisson  manifold  P,  the 
Hamiltonian  vector  field  associated  with  H  is  a  unique  smooth  vector  held,  de¬ 
noted  by  XH,  satisfying 

Xh(F)  =  {F,  H},  for  every  F  G  C°°(P).  (2.13) 

The  equations  governing  the  how  of  XH  are  referred  to  as  the  Hamilton’s  equa¬ 
tions  for  the  Hamiltonian  function  H.  Defining  the  Poisson  bracket  on  a  sym- 
plectic  manifold  (P,  Q)  as 

{F,G}(z)  =  n(XF(z),XG(z))  zeP  (2.14) 

one  observes  that  the  definition  (2.13)  agrees  with  (2.7). 

A  smooth  mapping  /  :  Pi  — >  P2  between  two  Poisson  manifolds  (Pi,  {•,  -}i)  and 
(P^,  {•,  -}2)  is  called  a  canonical  or  Poisson  map  if 

J'{F  Gh  =  { S’F ,  f'G}  i  »  {F,  G}2  o  /  =  {F  o  /,  G  o  /},.  (2.15) 
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As  in  the  symplectic  case,  flows  of  Hamiltonian  vector  fields  are  Poisson  maps, 
and  hence  preserve  the  Poisson  structure.  Further  Poisson  maps  push  Hamilto¬ 
nian  flows  to  Hamiltonian  flows  (cf.  [Marsden  and  Ratiu,  1994]  Prop.  10.5.2). 


Theorem  2.1.5  Let  f  :  P\  — >  P2  be  a  Poisson  map.  If  (fit  is  the  flow  of  Xh  and 
tfit  is  the  flow  of  Xhof,  then  (fit  o  f  =  /  o  ifit  and  Tfo  XHof  =  XH  o  f 


In  finite  dimensions  one  can  show  that  to  compute  the  Poisson  bracket  of  any 
pair  of  functions  F,G  G  C°°(P)  in  some  given  local  set  of  coordinates,  it  suffices 
to  know  the  Poisson  bracket  between  the  coordinate  functions  themselves.  Let 
x  =  (xi, . . .  xm )  be  local  coordinates  on  P.  Then 

r  p  rn  SX  V"  r  i  dG 

i=  1  j= 1  *  3 

or 

{F,G}  =  VFA(x)VG',  where  =  {xt,Xj}.  (2-16) 


A  is  a  skew  symmetric  matrix  and  is  again  referred  to  as  the  Poisson  tensor. 
For  example,  on  H2n,  with  coordinates  (qi, ,  qn,  pl , . . . ,  pn)  (for  a  mechanical 
system  p’s  would  represent  momenta  and  q's  positions)  the  associated  canonical 
bracket  is  given  by 


\FG\  =  V—  —  — 

dqt  dp 1  dp 1  dqt 

and  the  Poisson  tensor  A  then  takes  the  form 


F,G  eC°°(]R2n), 


(2.17) 


A 


0  I 
—I  0 


where  I  =  n  x  n  identity  matrix. 
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Hence,  given  a  Hamiltonian  H  :  P  — >  1R  the  associated  system  of  Hamilton’s 
equations  take  the  form 


Q 

V 


U,H} 

{p,H} 


dH 
dp  1 
dH 
dq 


One  of  the  important  examples  of  Poisson  structures  is  the  one  on  the  dual  of 
the  Lie  algebra  of  a  Lie  group  G.  Let  us  assume  that  G  has  dimension  r.  Let 
{£1, . . . ,  £r}  and  {^, . . . ,  ££}  be  a  basis  for  the  Lie  algebra  g  and  a  dual  basis  for 
the  dual  space  g*  respectively,  i.e.  <  £.■ ,  >=  Sj.  Any  //  eg*  can  be  expressed 

as  //  =  Y2i= i  Pi£i-  The  minus  Lie-Poisson  bracket  of  two  differentiable  functions 
F,G  G  C'°°(g*)  is  given  by 

r  ap 

(f’c|-w  =  T4^  (2-18> 

i,j,k=  1 

where  ck, i,j,  k  =  1 , ,r  are  the  structure  constants  of  g  relative  to  the  basis 
{£l,  . . .  ,Cr}-  Equivalently  (2.18)  can  be  written  as 

{F,  H}_( n)  =  VFTA(//)Vff  (2.19) 

where 

r 

[AW]«  =  -Ec‘#‘-  (2.20) 

k= 1 

The  manifold  g*  together  with  its  minus  Lie  Poisson  bracket  is  a  Poisson  manifold 
and  is  denoted  by  g*l.  (The  manifold  g*  together  with  its  plus  Lie  Poisson  bracket 
is  a  Poisson  manifold  and  is  denoted  by  g^.)  The  minus  Lie-Poisson  bracket  can 
also  be  defined  in  its  coordinate-free  form  as 


{F,G}W  =  -((.,[VFW,VGM]),  JU6  0-  (2.21) 
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where  [•,  •]  is  the  Lie  bracket  on  g.  Hence  if  H  :  g*  — »  H  is  a  Hamiltonian,  then 
the  Hamilton’s  equations  associated  to  the  minus  Poisson  bracket  are 

fi  =  A  (ii)VH 

where  A(/x)  is  as  dehned  in  (2.20). 

A  function  C  G  C°°(P )  is  called  a  Casimir  function  if  {C,  F}  =  0  for  all  F  G 
C°°(P).  Hence  C  is  a  constant  along  the  flow  of  all  Hamiltonian  vector  fields 

xHeP. 

In  order  to  gain  a  complete  understanding  of  the  geometry  underlying  a  general 
Poisson  structure  on  a  smooth  manifold,  we  need  to  look  more  closely  at  the 
Poisson  tensor  A,  which  determines  in  local  coordinates  the  Poisson  bracket. 
The  most  important  invariant  of  this  tensor  is  its  rank.  If  the  rank  of  the  Pois¬ 
son  tensor  is  maximal  everywhere,  then  the  manifold  is  symplectic  and  we  are 
in  the  setting  of  Hamiltonian  systems  on  symplectic  manifolds.  In  the  case  of 
variable  rank,  the  Poisson  manifold  is  naturally  foliated  by  symplectic  submani¬ 
folds  or  symplectic  leaves  (see  definition  below)  and  any  Hamiltonian  system  on 
M  restricts  to  one  of  these  leaves. 

Let  P  be  a  Poisson  manifold.  Points  z i,  are  said  to  be  on  the  same  symplectic 
leaf  of  P  if  there  is  a  piecewise  smooth  curve  in  P  joining  Z\,Z2,  each  segment 
of  which  is  a  trajectory  of  a  locally  dehned  Hamiltonian  vector  held.  This  is  an 
equivalence  relation  and  the  equivalence  class  is  called  a  symplectic  leaf.  The 
symplectic  leaf  containing  the  point  z  is  denoted  by  Ez.  The  following  theorem 
on  symplectic  stratification  was  proved  in  the  hnite-dimensional  case  by  [Lie, 
1890]  and  then  by  [Kirillov,  1976]. 
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Theorem  2.1.6  (Symplectic  Stratification  Theorem)  Let  P  be  a  finite- 
dimensional  Poisson  manifold.  Then  P  is  the  disjoint  union  of  its  symplectic 
leaves.  Each  symplectic  leaf  in  P  is  an  injectively  immersed  Poisson  submanifold 
and  the  induced  Poisson  structure  on  the  leaf  is  symplectic.  The  dimension  of 
the  leaf  through  z  equals  the  rank  of  the  Poisson  structure  at  z. 

The  induced  symplectic  foliation  by  the  Lie-Poisson  bracket  on  gl  has  a  par¬ 
ticularly  nice  interpretation  in  terms  of  the  dual  to  the  adjoint  representa¬ 
tion  of  the  underlying  Lie  group  G  on  the  Lie  algebra  g.  This  is  given  by 
the  following  theorem,  which  appears  to  be  due  to  Kirillov,  Arnold,  Kostant 
and  Souriau,  though  similar  ideas  first  appear  in  the  work  of  Lie,  Berezin  and 
Weil.  (See  [Marsden  and  Ratiu,  1994]  for  historical  comments  and  references.) 
The  proof  of  the  following  theorem  can  be  found  in  [Marsden  and  Ratiu,  1994; 
Olver,  1993] 

Theorem  2.1.7  Let  G  be  a  connected  Lie  group  with  coadjoint  representation 
Ad*G  on  gL.  Then  the  orbits  of  Ad*G  are  immersed  submanifolds  of  q*_  and  are 
precisely  the  leaves  of  the  symplectic  foliation  induced  by  the  minus  Lie-Poisson 
bracket  on  gb.  Moreover,  for  each  g  e  G,  the  coadjoint  map  Ad*G  is  a  Poisson 
mapping  on  g*  preserving  the  leaves  of  the  foliation. 

2.1.3  Symmetry  and  Reduction 

Let  G  be  a  Lie  group  and  :  M  — »  M  denote  the  action  of  G  on  a  manifold  M. 
A  function  /  :  M  — >  IV,  where  N  is  a  manifold,  is  called  a  G-invariant  function, 
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and  G  is  called  the  symmetry  group,  if  for  all  x  E  M  and  all  g  G  G 


f^g-x)  =  f{x). 

G  is  a  symmetry  group  of  a  system  of  differential  equations  S,  (<f>9  acting  on  an 
open  subset  M  of  independent  and  dependent  variables  of  the  system),  if  it  has 
the  property  that  whenever  z  =  h(x )  is  a  solution  of  S,  then  z  —  $9  •  h(x)  is 
also  a  solution  of  S.  In  the  setting  of  ODE’s  we  have  the  following  necessary 
and  sufficient  condition.  Given  a  set  of  ODE’s 

x  =  f(x),  x=(xi  ,...,xn)eM  (2.22) 

then  G  is  a  symmetry  group  of  (2.22  )  or  equivalently  (2.22)  is  G  invariant  if 
and  only  if 

Tx*g-f{x)  =  f($g-x).  (2.23) 

In  this  dissertation  we  are  mainly  concerned  with  dynamics  evolving  on  the 
cotangent  bundle,  T*W,  of  a  Lie  group  W,  and  the  invariance  of  Hamiltonian 
vector  fields  XH  defined  on  T*W  to  some  subgroup  G  of  W .  In  many  cases  we 
will  observe  that  G  =  W.  In  this  setting,  $9  corresponds  to  the  cotangent  lift 
of  Lgi  the  left  action  of  G  on  W.  Hence  we  define  a  function  F  :  T*W  — »  1R  as 
left-invariant  if  for  all  g  G  G, 


F  o  T*Lg  =  F.  (2.24) 

Here  the  cotangent  lift  of  Lg  on  T*W  is  denoted  by  T*Lg.  Similarly  a  vector 
held  X  is  left  invariant  if 

T(T*Lg)  o  X{x)  =  X(T*Lgx ),  x  G  T*W.  (2.25) 
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Remark  2.1.8  One  could  have  similarly  defined  right  invariance  of  functions 
and  vector  fields  with  respect  to  the  right  action  Rg.  We  will  concern  ourselves 
with  only  left  actions  and  left  invariance  in  this  dissertation  and  depending  on 
the  context  the  reader  should  interpret  G  invariance  to  mean  left  invariance. 

Lemma  2.1.9  Let  G  be  a  subgroup  of  H .  If  H  :  T*W  — *  1R  is  left  invariant, 
then  the  Hamiltonian  vector  field,  Xu  is  left  (G)  invariant. 

Proof:  The  cotangent  lift  of  Lg  on  T*W  is  always  symplectic  and  therefore  a 

Poisson  map.  Since  T*Lg  o  II  =  11  (by  left  invariance),  substitute  for  /  =  T*Lg 
and  P\  =  P2  =  T*W  in  Theorem  2.1.5  and  the  proof  follows.  ■ 

Given  a  G-invariant  vector  field  X  defined  on  a  manifold  M,  if  the  action  of  G 
is  free  and  proper,  then  there  is  an  induced  vector  field  X(tt(x))  =  Ttt(X(x))  on 
the  quotient  manifold  M/G  such  that 


<t>t  (7r(x))  =7ro  (2-26) 

where  7r  :  M  — »  M/G  is  the  projection  map  and  <f>*(-)  denotes  the  flow  of 
the  vector  field  X.  While  in  the  general  setting  solving  for  X  can  be  quite 
complicated,  in  the  setting  of  left- invariant  Hamiltonian  vector  fields  defined  on 
Poisson  manifolds  the  geometry  can  be  exploited  to  solve  for  X. 

If  the  action  :  P  — »  P  of  a  Lie  group  G  on  a  Poisson  manifold  (P,  {•,•})  is 
free  and  proper  and  <3>9  is  a  Poisson  map,  then  there  exists  a  unique  Poisson 
structure  on  P/G  denoted  by  {-,-}p/g  such  that  the  projection  tt  :  P  —?  P/G 
is  a  Poisson  map  (cf.  [Marsden  and  Ratiu,  1994]  (Prop.  10.7.1)).  Hence  if  H 
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is  G  invariant  Hamiltonian  on  P.  it  defines  a  corresponding  function  H  on  P/ G 
such  that  H  =  H  o  tt.  Under  the  above  assumptions,  7r  is  a  Poisson  map  and 
hence  from  Theorem  2.1.5  Tn  oI„  =  Xf~f  o  n .  Hence  a  G'-in  variant  Hamiltonian 
vector  held  Xh  reduces  to  the  Hamiltonian  vector  held  Xg  on  P/G.  Further 
Xf{  is  Hamiltonian  with  respect  to  the  reduced  Hamiltonian  H  and  the  Poisson 
structure  {•,  -}p/g- 

In  the  special  case  where  P  =  T*G  and  P/G  =  T*G/G  =  g*,  the  Lie  Pois¬ 
son  reduction  theorem  (cf.  [Marsden  and  Ratiu,  1994;  Weinstein,  1983b;  Krish- 
naprasad,  1993])  relates  the  canonical  Poisson  bracket  on  T*G  to  the  Lie-Poisson 
bracket  on  g*.  We  only  present  the  case  of  left  invariance. 

Theorem  2.1.10  (Lie-Poisson  Reduction  Theorem)  Identifying  the  set  of 

functions  on  g*  with  the  set  of  left  invariant  functions  on  T*G  endows  g*  with  a 
Poisson  structure  given  by 

{ F,G }_(/<)  =  -</*,  [VF,  Vff]>  F,G  6  e  8*. 

As  mentioned  earlier,  the  space  g*  with  this  Poisson  structure  is  denoted  by  g*  . 
The  Poisson  map  tt  :  T*G  — >  g  is  given  by 

OLg  I - }  T£  Lg  •  OLg ,  OLg  G  T  G. 

Hence  the  reduced  dynamics  with  respect  to  coordinates  (/ii, . . .  fir)  dehned  on 
gh  and  the  reduced  Hamiltonian  H  are  given  by 

hi  =  {pX5}-  i  =  l,...m, 

or  equivalently  as 

A  =  Xs(n)  =  A(n)XH,  n  G  g*. 
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Remark  2.1.11  The  notation  ag  — »  T*Lg  ■  ag  needs  some  explanation  as  it 
is  an  abuse  of  notation.  Let  ag  G  T*G  have  a  local  coordinate  representation 
(g,Pg),  he.  pg  G  Tg*G.  Then  T*Lg  ■  ag  :=  T*Lg  ■  pg  w,g  G  G.  Recall  that 
T*Lg  :  Tfg.wG  — »  T*G.  Hence  T*Lg-ag  maps  objects  in  the  fiber  of  the  cotangent 
bundle  over  g.  to  objects  in  T*G  =  g*.  This  notation  is  used  in  literature  to 
avoid  the  mess  of  further  notation  involved  in  expressing  everything  in  terms  of 
local  coordinates. 

We  now  discuss  semidirect  products  and  reduction.  We  state,  without  proof, 
the  semidirect  product  reduction  theorem.  The  theorem  shows  how  to  reduce  a 
Hamiltonian  system  on  the  cotangent  bundle  of  a  Lie  group  to  a  Hamiltonian 
system  in  the  dual  of  the  Lie  algebra  of  a  semidirect  product.  Before  we  state  the 
theorem,  we  review  some  basic  facts  and  notation  about  semidirect  products. 

Given  a  Lie  group  G.  let  p  denote  the  left  representation  of  G  on  a  vector  space 
V.  Let  p*  :  g  i — y  [pt]#-1)]*,  9  £  G,  denote  the  associated  left  representation  of 
G  on  V*.  The  right  representation  of  G  on  V*  is  given  by  p*  :  g  i— >  [p(g)]*.  Let 
Ga  denote  the  stabilizer  of  a  G  V*  under  p*,  ga  its  Lie  algebra,  S  =  G  xp  V  the 
semidirect  product,  and  s  its  Lie  algebra.  Group  multiplication  in  S  is  given  by 

(gi,v i)  •  (g2,v2)  =  (gig2,vi  +  giv2),  gi,g2  e  G,v i,v2  g  V 

where  the  action  of  g  on  v  is  denoted  by  gv.  The  Lie  algebra  5  of  is  the  semidirect 
product  of  the  Lie  algebras,  i.e.  s  =  g  xpV  and  the  Lie  bracket  in  s  is  defined 
by 

[(£iwi),  (6W2)]  =  ([fi,6],fw2-6vi),  £1,6  e  g,vuv2  g  V. 

In  [Ratiu,  1980;  1981;  1982]  it  was  shown  that  reducing  T*G  by  the  left  action 
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of  Gai  in  the  sense  of  [Marsden  et  al,  1984]  leads  to  coadjoint  orbits  for  S. 
For  historical  remarks  see  [Marsden  et  al. ,  1984]  where  the  following  theorem  is 
proved. 

Theorem  2.1.12  (Semidirect  Product  Reduction)  The  reduction  of  T*G 
by  Ga  at  values  fia  =  n  |flo  gives  a  space  that  is  isomorphic  to  the  coadjoint  orbit 
through  the  point  a  =  (//,  a)  G  s*  =  g*  x  V* ,  the  dual  of  the  Lie  algebra  of  S. 

Hence  if  Ha  :  T*G  — »  G  is  a  left-invariant  Hamiltonian  under  the  action  on 
T*G  of  the  stabilizer  Ga:  the  family  of  Hamiltonians  {Ha  \  a  G  V *}  induces 
a  Hamiltonian  function  h  on  $*_  =  T*G/Ga ,  dehned  by  h((TeLg)*ag,  p*(g)a)  = 
Ha(a.g).  Hence  canonical  Hamiltonian  dynamics  on  T*G,  with  respect  to  Ha 
project  to  Lie- Poisson  dynamics  on  s!_,  with  respect  to  the  Lie- Poisson  structure 
dehned  on  sL  and  the  reduced  Hamiltonian  h. 


2.2  Hamiltonian  Control  Systems  with  Symme¬ 
try 

The  main  goal  of  this  section  is  to  define  what  we  mean  by  a  Hamiltonian  control 
system  with  symmetry.  The  approach  adopted  here  is  in  the  same  spirit  as  that 
of  [van  der  Schaft,  1981;  Grizzle  and  Marcus,  1985;  de  Alvarez,  1986]  with  some 
differences. 

Definition  2.2.1  A  nonlinear  control  system  S  is  a  3-tuple  (E,  M,  /)  where  the 
projection  i r  :  R  — )■  M  (see  Figure  2.1)is  a  smooth  fiber  bundle  and  /  is  a  smooth 
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B 


v| /  :  (x,  u)  ->  (x,  f(x,u)) 

— ►  TM 


Figure  2.1:  Nonlinear  Control  System 
map  such  that  Fig  (2.1)  commutes. 

Here  nm  (see  Figure  2.1)  is  the  natural  projection  of  TM  on  M.  M  is  to  be  inter¬ 
preted  as  the  state  space  and  the  fibers  of  B  as  the  input  spaces.  If  one  chooses 
fiber-respecting  coordinates  (x,  u )  for  B,  then  locally  this  definition  reduces  to 
0  :  (x,u)  i->-  (x,if)(x,u))  i.e. 

X  =  0(x,  u). 

In  the  problems  that  we  will  be  studying  in  this  dissertation  we  make  the  fol¬ 
lowing  assumptions  on  M,B  and  0. 

(Al)  M  =  T*W  is  the  cotangent  bundle  of  a  Lie  group  W . 

(A2)  B  has  a  trivial  bundle  structure  M  x  U  and  M  is  a  Poisson  manifold 

(V,  {-,}). 

(A3)  0  is  of  the  following  specific  form,  0  :  (x,  u )  (->■  (x,  f(x)+g(x,  u ))  g(x,  0)  = 
0  where  /(•)  is  a  Hamiltonian  vector  held  with  respect  to  a  Hamiltonian  H  :  M  — > 
]R  and  the  Poisson  structure  defined  on  M. 
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g 

Figure  2.2:  Hamiltonian  control  system  with  symmetry 


Definition  2.2.2  A  nonlinear  Hamiltonian  control  system  E h  is  a  nonlinear 
control  system  E  satisfying  (Al)-(A3). 

Let  G  be  a  subgroup  of  W  that  acts  on  W  via  left  actions  and  let  T* Lq  '■  T*W  — >• 
T*W  denote  its  cotangent  lift.  Assume  that  the  action  T*Lg  is  free  and  proper. 
Then  E/E#  is  G  invariant  or  is  said  to  have  (G,  $),  $  =  T*Lg  symmetry  if  the 
Figure  2.2  commutes  for  all  g  G  G. 

Let  A,  denote  the  projection  A  :  T*W  — *  T*W/G.  Then  based  on  the  discussions 
in  Section  2.1.3  we  have  the  following  proposition  : 

Proposition  2.2.3  If  E#  has  (G,  <f>)  symmetry  then  E H  projects  to  E ^(M/Gx 
U,M/G,$).  If  XH  =  E ?=1fi(x)-£:  and  Y  =  EJL^x, it)^-  are  G  invari¬ 
ant  vector  fields  and  each  of  them  projects  to  vector  fields  =  \*(XH)  = 
E l=1{fi,  H}m/g-£t  and  Y  =  A*(F)  defined  on  M/G.  A  is  the  projection  A  : 


28 


M  —>  M/G  and  H  is  the  reduced  Hamiltonian  s.t  H  =  H  on. 

In  the  setting  where  M  =  T*G  we  know  that  the  projection  A  :  T*G  — »  T*G/G  = 
0*  is  given  explicitly  by  X(ag)  =  T*Lg  ■  ag  and  hence  solving  for  Y  is  not  too 
difficult. 

Remark  2.2.4  In  the  work  of  [van  der  Schaft,  1981;  de  Alvarez,  1986]  it  was  as¬ 
sumed  that  the  vector  held  Y  was  of  the  form  Ep-=1 Xn^Uj,  where  each  Xhj,  j  = 
1 , . .  .p.  was  required  to  be  Hamiltonian  with  respect  to  some  function  Hj  :  M  — > 
R  and  the  canonical  Poisson  bracket  on  M.  As  we  shall  see,  it  is  not  always 
possible  for  the  control  vector  held  Y  to  have  this  form. 

2.2.1  Reconstruction  of  Dynamics 

The  reduced  system  induced  on  M/G  represents  in  a  sense,  the  “essential  dy¬ 
namics”  .  The  explicitly  known  dynamics  have  been  factored  out  in  the  reduction 
process.  If  we  know  a  solution  of  the  reduced  nonlinear  system  we  would  like 
to  reconstruct  the  solutions  of  the  unreduced  nonlinear  system  £#.  For  the  case 
u  =  0  this  procedure  is  outlined  in  [Abraham  and  Marsden,  1977].  This  tech¬ 
nique  is  adopted  in  [Grizzle  and  Marcus,  1985]  to  reconstruct  trajectories  for  the 
more  general  case  with  inputs,  and  the  further  assumption  that  A  :  M  — >  M/G 
admits  a  smooth  cross  section.  The  reconstruction  of  trajectories  is  outlined 
below. 

Let  xo  €  M,  «(•)  be  a  continuous  input,  x(-)  the  integral  curve  of  'Eh  corre¬ 
sponding  to  u(-)  and  //(•)  =  A(x(-))),  the  corresponding  integral  curve  of  E^ 
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having  /r(0)  =  A(x(0)).  Assume  that  A  :  M  — >  M/G  admits  a  cross  section  er. 
Dehne  a  differentiable  curve  d(t)  in  M  by  d(t)  =  a(fj,(t)).  Since  A (x(t))  =  A (d(t)) 
and  $  is  free  and  proper,  one  can  write  x(t)  =  ®g(t)  (d(t))  for  a  uniquely  defined 
curve  g(t)  G  G.  We  now  try  to  hnd  g{t).  Now 

®  =  ^(9{t),d(t))  =  Td{t)<$>g{t)d(t)  +  Tg{t)<S>mg(t).  (2.27) 

Note  that  g(t )  G  Tg^G  is  a  left- invariant  vector  held.  But  for  any  left-invariant 
vector  held  £g  we  have  =  TeLg £,  £  G  g.  Thus  for  m  G  M 

Tg$m(Q  =  T9®m  °  TeLg(0  =  Te{$m  O  Lg)£  (2.28) 

=  Te($s  O  $m)(0  =  Tm$s  O  Te$m(£)  (2.29) 

but 

(Te<f>m)£  =  -^-$(expt£,  m)  |t=0=  £m(™)  (2.30) 

is  the  infinitesimal  generator  (c.f.  2.6)  for  $  corresponding  to  £.  Hence 

$m(4)  =  Tm$9(TeLg-i4)M(m)  (2.31) 

Substituting  (2.31)  in  (2.27) 

f(x(t),u(t ))  =  7d(t)$fl(t)d(t)  +  Td(t)$fl(i)(Tfl(t)Lg-i^(t))M(d(t)).  (2.32) 

Since  E/,.  has  (G,  <3>)  symmetry 

Tm$>gf(m,u)  =  /($fl(m),u).  (2.33) 

Hence  we  have 

<T>ff(t)/((/(t),  -«(<))  =  Td(t)$fl(t)d(i)  +  rd(t)$gW(TeL9-i^(t))M(d(t)). 
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Since  :  M  — »  M  is  a  diffeomorphism  for  all  g ,  Td(q<f>9(t)  is  nonsingular.  Hence, 
f{d{t),u{t ))  =  d{t)  +  (Tg(t)Lg-i  g(t))  M{d(t)) .  =  d(t)  +  £jif(d(t)) 
where  Cm  =  {Tg^Lg-ig(t))M(d(t)).  Thus  from  (2.31) 

TMd(t)m)  =  CM(d(t))  =  f(d(t)Mt))  “  d(t).  (2.34) 

$  being  free  and  proper  implies  that  :  G  —r  M  is  a  diffeomorphism  onto  is 
range,  and  hence  (2.34)  can  be  uniquely  solved  for  £(t)  to  give 

m  =  (Te^-^Mt))  (2.35) 

or 

Tg(t)Lg-i(t)g(t)  =  (Te$d(i))_1^M(d(f))  (2.36) 

Since  Lg  is  a  diffeomorphism  for  all  g  and  d(t)  =  a(y(t))  we  have 

g(t)  =  (TeLg{t))(Te$d{t)[f(<j(y(t)),u(t))  -  (: Ty{t)cr)f(y(t),u(t ))].  (2.37) 

Hence  to  reconstruct  trajectories  one  solves  the  algebraic  problem  (2.35)  for 

((f)  G  0  and  then  solves  (2.37)  for  g(t).  The  desired  solution  x(t)  then  is 

x(t)  =  $s(i)d(t). 

We  end  this  chapter  with  some  dehnitions  and  theorems  on  controllability  of 
nonlinear  systems. 


2.3  Accessibility  and  Controllability 

The  problem  of  local  and  global  controllability  of  nonlinear  systems  has  had  a 
long  history.  Some  of  the  early  work  [Lee  and  Markus,  1976]  (and  references 
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therein)  on  nonlinear  controllability,  is  on  the  theorem  that  states  that  if  the 
linearization  of  a  nonlinear  system  at  an  equilibrium  point  xe  is  controllable  the 
system  itself  is  locally  controllable.  More  recently  a  differential  geometric  ap¬ 
proach  to  the  problem  was  adopted  in  which  a  control  system  was  viewed  as 
a  family  of  vector  fields.  It  was  observed  that  (cf.  [Hermann,  1968;  Hermann 
and  Krener,  1977;  Hermes,  1974;  Krener,  1974;  Sussmann  and  Jurdjevic,  1972; 
Lobry,  1970]))  a  considerable  amount  of  interesting  control  theoretic  information 
was  contained  in  the  Lie  brackets  of  these  vector  fields.  It  was  realized  [Hermann 
and  Krener,  1977;  Krener,  1974]  that  Chow’s  theorem  [Hermann,  1968]  led  to 
the  characterization  of  controllability  for  systems  with  “symmetry”  x,  (systems 
such  that  every  trajectory  run  backwards  in  time  is  also  a  trajectory).  In  this 
section  we  introduce  some  definitions  and  related  theorems  on  accessibility  and 
controllability.  [Nijmeijer  and  van  der  Schaft,  1990]  will  serve  as  our  main  source 
of  reference.  Further  discussions  on  small  time  local  controllability  and  control¬ 
lability  of  systems  with  drift  can  be  found  in  Chapter  3 

Consider  an  affine  nonlinear  control  system  given  by 

m 

X  =  f{x)  +  ^2  9i(x)ui,  (2.38) 

i= 1 

where  x  =  (xo,...,xn)  are  local  coordinates  for  a  smooth  manifold  M  and 
u  =  (mi,... um)  G  U  C  Rm.  It  is  assumed  that  - 

(i)  The  input  space  U  is  such  that  the  set  of  associated  vector  fields  of  (2.38) 
F  =  if(x)  +  9i(x)Ui  |  (til,  .  .  .Um)  G  U}. 

(ii)  The  set  of  admissible  controls  consists  of  piecewise  constant  functions  which 

1“he  .sage  wf  ehe  word  “symmetry”  an  ehis  setting  should  uot  be  confused  with  ehat  wf 
2.23P 
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are  piecewise  continuous  from  the  right. 


The  set  T  defines  a  dynamical  polysystem  [Jurdjevic  and  Kupka,  1981;  Lobry, 
1974],  A  polysystem  on  a  manifold  M  is  simply  a  collection  of  vector  fields  on 
M.  An  integral  curve  of  T  corresponds  to  a  trajectory  of  (2.38)  with  piecewise 
constant  inputs. 

Definition  2.3.1  The  accessibility  algebra  C  is  the  smallest  subalgebra  of  V°°(M) 
(the  Lie  algebra  of  vector  fields  on  M)  that  contains  T . 

Hence  the  smallest  Lie  algebra  that  contains  T  is  the  one  generated  by  /,  <71, . . . ,  gm. 

The  accessibility  distribution  L  is  the  distribution  generated  by  the  accessibility 
algebra  C,  i.e., 


L(x)  =  span{X(x)|A"  vector  field  in  £}  ,x  G  M 

Definition  2.3.2  The  system  is  said  to  satisfy  the  accessibility  Lie  algebra  rank 
condition  (LARC)  if 

L(x )  =  TXM  Vx  G  M  (2.39) 

Let  x(t,  0,  Xo,  u )  denote  the  solution  of  (2.38)  at  time  t  >  0  for  a  particular  input 
function  u(-)  and  initial  condition  x(0)  =  xq. 

Let  Rv(Jr:  xq,  T)  denote  the  reachable  set,  dehned  as 

RV(JZ1  xo,  T)  =  {x  G  M  |  there  exists  an  admissible  input  u  :  [0,  T]  — »  U 
such  that  x(t,  0,  x0,  u)  G  V,  0  <  t  <  T  and  x(T)  =  x} 
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Let 


Rv(lF,Xo,<T)  —  \^J  Rv(1F,x0,t)  and 

t<T 

R(F,X o)=  U  RM(T,  Xq,  <  T). 

0<T<oo 

Definition  2.3.3  The  system  (2.38)  is  locally  accessible  from  x0  if  RV  (IF,  xq,  < 

T )  contains  a  non-empty  open  set  of  M  for  all  neighborhoods  V  of  Xo  and  all 
T  >  0.  If  this  holds  for  any  x0  E  M,  the  the  system  is  called  locally  accessible. 

Theorem  2.3.4  [Lobry,  1970;  Sussmann  and  Jurdjevic,  1972]  The  system  (2.38) 
is  locally  accessible  iff  dimL(x)  =  n  Vx  E  M 

Definition  2.3.5  The  system  (2.38)  is  said  to  be  locally  strongly  accessible  from 
Xq  if  for  any  neighborhood  V  of  x0  the  set  Rv (IF,  x0,T)  contains  a  non-empty 
open  set  for  any  T  >  0  sufficiently  small. 

Let  jC0  be  the  smallest  Lie  subalgebra  which  contains  (j\, ,  grn  and  satisfies 
[/,  X]  E  Cq,"7X  E  Cq  and  L0(x)  =  span{X(x)  |  X  vector  held  in  £0}  ,x  E  M. 

Definition  2.3.6  The  system  is  said  to  satisfy  the  strong  accessibility  Lie  alge¬ 
bra  rank  condition  if 

Lq(x)  =  TXM ,  Vx  E  M  (2.40) 

Theorem  2.3.7  If  dimL0(x o)  =  n,  then  the  system  (2.38)  is  locally  strongly 
accessible  from  xq. 
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The  system  (2.38)  is  called  controllable  if  for  any  two  points  x\,x2  in  M  there 
exists  a  finite  time  T  and  an  admissible  function  u  :  [0,  T]  — »  U  such  that 
x(t,  0,  xi,  u)  =  x2. 

In  terms  of  reachable  sets  the  controllability  definitions  can  be  stated  as  follows. 

Definition  2.3.8  The  dynamical  polysystem  T  is  controllable  if  R{fF  ,x o)  =  M 

Definition  2.3.9  A  dynamical  polysystem  is  said  to  be  symmetric  if  for  every 

X  e  T,  -X  e  T. 


For  systems  without  drift,  i.e.  /  =  0,  or  equivalently  a  symmetric  polysystem 
LARC  implies  controllability. 

Theorem  2.3.10  (Chow,  c.f.  [Hermann,  1968])  The  nonlinear  system 

m 

X  =  y^gi(x)uj,  u  =  (til,  •  •  •  ,um)  C  U  (2.41) 

i= 1 

is  controllable  if  the  accessibility  LARC  is  satisfied. 
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Chapter  3 


Left-Invariant  Hamiltonian  Systems: 
Examples,  Dynamics  and  Reduction 


The  configuration  space  of  a  large  class  of  mechanical  systems  can  be  identi¬ 
fied  with  Lie  groups  G.  Often  the  dynamics  of  such  systems  are  6'- invariant 
and  hence  they  can  be  reduced  to  obtain  a  set  of  reduced  dynamics  on  T*G/G. 
Examples  of  such  systems  include  hovercraft,  spacecraft  and  underwater  vehi¬ 
cles  modeled  as  rigid  bodies.  See  also  [Bloch  et  al,  1992a;  Krishnaprasad  and 
Tsakiris,  1994;  1995;  Krishnaprasad,  1995;  Wang,  1990]  for  some  more  examples. 
The  design  and  control  of  autonomous  versions  of  these  vehicles  has  been  of  much 
recent  interest.  For  example  the  amphibious  versatility  of  hovercraft  has  given 
them  a  role  in  specialized  applications  including  search  and  rescue,  emergency 
medical  services,  ice  breaking,  Arctic  off-shore  exploration,  and  recreational  ac¬ 
tivities  [Amyot,  1989].  Certain  environmental  aspects  (such  as  ice-roughness, 
Arctic  rubble  fields  etc.)  also  provide  a  niche  for  operations  by  hovercraft.  Sim¬ 
ilarly  a  growing  industry  in  underwater  vehicles  for  deep  sea  explorations  has 
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led  to  the  demand  for  more  versatile,  robust  and  high  performance  autonomous 
vehicles  that  can  cope  with  actuator  failures,  disturbances,  exploit  sensor  based 
local  navigation  etc.  In  this  chapter  we  discuss  the  modeling  and  reduction  of  the 
dynamics  of  hovercraft,  spacecraft  and  underwater  vehicles  subject  to  external 
forces. 


3.1  Hovercaft:  Planar  Rigid  Body  with  a  Vec¬ 
tored  Thrust 


A  configuration  of  the  system  is  shown  in  Figure  3.1.  Let  { ej ,  eT2 ,  ef }  be  an 
inertial  frame  of  reference  fixed  at  O  and  { e\ ,  eb ,  e\ }  be  a  body  frame  fixed  on 
the  rigid  body  B  at  its  center  of  mass.  Since  the  rigid  body  is  restricted  to  move 
in  the  e\er2  plane  erz  is  parallel  to  e\.  A  typical  material  point  qb  in  the  rigid 
body  is  then  represented  in  the  inertial  frame  as  qr  =  Rqb  +  r  where  R  is  an 
element  of  SO(2),  the  special  orthogonal  group  of  2  x  2  matrices  and  r  =  (x,  y) 
is  a  vector  from  O,  the  origin  of  the  inertial  coordinate  system,  to  the  center  of 
mass  of  B.  Hence  at  any  instant,  the  configuration  X(t)  of  B  can  be  uniquely 
identified  by  the  pair  ( R,  r)  or  equivalently  as  an  element  of  SE(2).  the  Special 
Euclidean  group  of  3  x  3  matrices.  Recall 


SE{ 2)  ^  { 


R  r 
0  1 


R  e  SO(2),re  R2} 


Let  us  assume  that  the  thruster  is  mounted  at  the  point  C  defined  by  the  vector 
db  in  body  coordinates  and  dT  in  the  inertial  frame  of  reference.  The  thrusters 
exert  a  force  fr  in  inertial  coordinates  such  that  the  line  of  action  of  the  force 
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Figure  3.1:  Planar  rigid  body  with  thruster 

passes  through  C  and  makes  an  angle  0  with  the  vector  db.  We  now  derive  the 
equations  of  motion  of  a  rigid  body  subject  to  a  force  fr  along  a  specified  line 
of  action. 

Let  =  6  denote  the  angular  velocity  and  v  —  (v\ .  v2)  denote  the  linear  compo¬ 
nents  of  the  translational  velocity  along  the  body  fixed  frame.  The  kinematics 
are  defined  by 

g  =  gi, 

or 

R  r  R  r  O  r 

0  0  0  1  0  1 

where  g  G  SE( 2)  and  £  is  a  curve  in  se(2),  the  Lie  algebra  of  SE( 2)  and 

0-1 

n  =  a 

1  o 
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Equivalently  the  kinematics  conld  be  written  as 


(3.1-a) 

(3.1-b) 


r  =  m 

r  =  Rv 

3.1.1  Newton-Euler  Description  of  Dynamics 

Let  p  =  mr  denote  the  linear  momentum.  Then  from  Newton-Euler  balance 
laws  we  know  that 

p  =  r  (3.2) 

Let  II  =  IQ  denote  the  scalar  angular  momentum  (about  an  axis  through  the 
center  of  mass  and  perpendicular  to  the  lamina).  Here  I  is  the  moment  of  inertia 
about  this  axis.  Then 

fl  =  db  x  F  (3.3) 

=  db\\F\\  sin (f)  (3.4) 

where  ||.F||  denotes  the  magnitude  of  the  force.  We  now  express  (3.2)  in  convected 
or  body  variables.  Define 

P  =  RTp 

then 

P  =  Rrp  +  Rrf) 

=  -QRTp+F 
=  -QP  +  F 

thus 

Pi  =  yP2  +  F\ 
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P-2  = 

where  we  have  substituted,  Q  =  n //. 
laws  the  dynamics  can  be  written  as 

r  = 
R  = 

Pi  = 
P2  = 
ri  = 


Collecting  together  Newton-Euler  balance 


Rv 

(3.5) 

Rtt 

(3.6) 

y  P2  +  Fi 

(3,7) 

-j  Pi  +  F2 

(3,8) 

dbxF 

(3.9) 

As  we  shall  see  in  the  following  section  equations  (3.7)-(3.9)  are  the  reduced 
equations,  defined  on  se( 2)*,  corresponding  to  that  of  a  Hamiltonian  control 
system  defined  on  T*SE( 2). 


3.1.2  Lie-Poisson  Reduction  and  Reduced  Dynamics 


The  kinetic  energy  of  the  rigid  body  relative  to  the  inertial  frame  is 


T  =  \jm2dm(qb) 
=  bfi2  +  ^IHI2 


where  m  is  the  total  mass.  We  assume  for  now  that  the  rigid  body  has  sufficient 
lift  and  glides  on  the  surface  with  no  friction.  Models  with  lift  and  friction  will 
be  studied  later.  Hence  the  Lagrangian  L  :  TSE(2 )  — >  1R  for  this  case  is  simply 
the  kinetic  energy,  i.e. 

L(R,r,R,r)  =  ha2+^\\f\\2  (3.10) 
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The  corresponding  Hamiltonian  on  T*SE(2 )  is  given  by 

H  =  i<n,r*n>+M!.  (3.11) 

The  dynamics  on  T*SE( 2),  written  as  a  Hamiltonian  control  system,  E # ,  takes 
the  form 

x  =  pi/m 
y  =  p2/m 

6  =  n// 

Pi  =  (cos(0 +  </>))«  (3-12) 

p2  =  (sin(0  +  d>))n 
n  =  (d  sin  (j>)u. 

In  (3.12)  u  is  the  magnitude  of  the  force  F.  Observe  that  Xu  is  a  Hamiltonian 
vector  held  with  respect  to  the  Hamiltonian  (3.11)  and  the  canonical  Poisson 
bracket  on  T*SE( 2). 

Let  Lg  denote  the  left  action  of  SE{2)  on  itself.  Hence  given  g  =  ( R,f),Lgg  = 
g  ■  g  =  ( RR ,  Rr  +  r). 

Proposition  3.1.1  The  Hamiltonian  control  system  E h  defined  by  (3.12)  has 
( T*SE(2),T*Lg )  symmetry. 

Proof:  Commutativity  of  Figure  2.2  is  equivalent  to  showing  that 

Tq(T*Lg)-^q,u)  =  ^T*Lg-q,u) 
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where  q  =  (x,  y,  0,p1,p2,  n)T, 

.  pi  d  p2  d  119  ,  .  d  .  .  d  j  .  ,  d 

ip{q,u)  =  — w-  +  — 7T  + Y7^  +  wcos(0  +  0)— +  'usm(6»  +  0)— +  «rfsm  0— 

mox  may  I  oO  op\  op2  oir 

and  T*Lg  :  T*SE( 2)  -+  T*SE( 2),  g  =  (x,  y,  0)  such  that 

(x,  y,  0,pi:p2i  n)  i-+  (x  cos0  —  y  sin  9  +  x,  xsin  0  +  y  cos  9  +  y,  0  +  0,  pi  cos  9  — 
p2  sin  9,  pi  sin  0  +  p2  cos  9,  n) . 

Hence 

cos  9  —  sin  0  0  0  0  0 

sin  9  cos  0  0  0  0  0 

0  0  1  0  0  0 

Tq{T*Lg)  ■  ip(q)  =  _  •if’(q,u) 

0  0  0  cos  0  —  sin  0  0 

0  0  0  sin  9  cos  0  0 

0  0  0  0  0  1 

(pi  cos  9  —  p2  sin  9)/m 
(pi  sin  0  —  p2  cos  9)/m 

n // 

1tcos(0  +  0  +  0) 
u  sin (0  +  0  +  0) 
dsin0 

=  ^(T*Lg.q,u) 

Hence  from  Proposition  2.2.3  it  follows  that  (3.12)  projects  to  a  Hamiltonian 
control  system  E^(se(2)*  x  U,se(2)*,ip).  We  now  solve  for  T,g.  Since 

(TL{R^)L(R,r,R,r)  =  L(RR,  Rr  +  f,  RR,  Rr)  =  -HI2  +  —  ||r||2  (3.13) 

2  2 


42 


the  Lagrangian  is  SE( 2)  invariant  and  hence  the  Hamiltonian  (3.11)  is  also 
SE(2)  invariant.  Hence  from  Theorem  2.1.10  Xu  projects  to  Lie- Poisson  reduced 
dynamics  on  g*.  The  projection  A  :  T*G  — *  g*  is  given  by  A  :  ag  H >  (TLc)*ag. 
Hence  we  chose  convected  variables  P  =  RTp  and  n  as  coordinates  for  g*. 

The  reduced  Hamiltonian  H  is  given  by 

H  =  —  n2  +  J0-.  (3.14) 

21  2m  y  J 

Choosing 

001  000  0  -1  0 

Xi=  000  ,  X2  =  001  ,  X3  =  1  0  0 

000  000  000 

as  a  basis  for  se( 2)  we  have  the  commutation  relations:  [AA,  X2]  =  0,  [Xi,  X3\  = 
—X2  and  [X2,  X3\  =  X\ .  The  Lie- Poisson  bracket  of  two  differentiable  functions 
G,  H  on  se(2)*  is  then  given  by 

{G,  H}_( y)  =  VGTA(/i)ViL  (3.15) 

where  \i  =  (Pi,P2,U)  G  se(2)*  and 

0  0  P2 

A  =  0  0  -Pi  ■ 

-Pi  Pi  0 

The  reduced  Hamiltonian  System  takes  the  form 

I^  =  Xh(^)  +  9u  (3-16) 

where  X g  =  A(//.)  V//  and  gu  is  the  external  force  projected  appropriately.  In 
the  present  setting 

g  =  (cos  (j),  sin  0,  \d\  sin  0)T. 
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Depending  on  the  control  authority  we  distinguish  two  versions  of  the  problem. 


Case  1:  The  Jet-Puck  Problem:  Here  we  assume  that  the  line  of  action  of 
the  force  is  fixed  (i.e.  (f)  is  fixed)  but  its  direction  can  be  reversed.  Equation  3.16 
take  the  form 


Pi  =  P2H/I  +  au 

P2  =  -PiU/I  +  (3u  (3.17) 

fl  =  d(3u 

where  a  =  cos  (j),  j3  =  sin  <f>  and  u  G  [1,  —1]. 

Case  2:  The  Hovercraft  Problem:  Here  we  assume  that  we  now  have  control 
over  both  the  magnitude  of  the  thrust  and  (j).  The  equations  now  take  the  form 

A  =  p2n//  +  m  cos(«2) 

P2  =  —  Pin//  +  ui  sin(n2)  (3.18) 

II  =  dui  sin(tt2) 

where  iq  <E  [-1, 1]  and  u2  E  0 max } 

Remark  3.1.2  If  the  actuation  (forces  and  torques)  on  the  a  rigid  body  are 
due  to  body  fixed  thrusters/actuators  then  these  forces  are  obviously  invariant 
to  translations  and  rotations,  i.e.  invariant  to  the  left  action  of  SE( 3),  or  any 
subgroup  of  it.  Let  us  assume  that  in  addition  the  Hamiltonian  defined  on  T*G 
is  G  invariant.  Then  the  Hamiltonian  control  system  (where  the  drift  vector 
held  is  a  Hamiltonian  vector  held  with  respect  to  the  canonical  Poisson  bracket 
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Figure  3.2:  Spacecraft  with  gas  jets 

on  T*G,  and  the  control  vector  held  is  due  to  body  fixed  thrusters/actuators) 
is  G  invariant.  This  follows  from  Lemma  2.1.9  and  the  fact  that  control  vector 
fields  are  G  invariant.  In  the  rest  of  the  examples  where  the  dynamics  of  a  rigid 
body  with  G  invariant  Hamiltonian  with  body  fixed  actuators/thrusters  shows 
up,  we  will  directly  proceed  to  write  down  the  reduced  dynamics. 


3.2  Attitude  Control  of  Spacecraft  with  Gas 
Jets 

We  now  discuss  the  dynamics  describing  spacecraft  attitude  control  with  gas  jet 
actuators.  Let  {e\,  eb,  eb}  be  a  body  frame  fixed  on  the  rigid  body  (spacecraft) 
at  its  center  of  mass  and  let  {ej,  er2,  ej}  be  an  inertial  frame  of  reference  with 
origin  coincident  with  the  origin  of  the  body  fixed  frame  (see  Fig  3.2).  A  typical 
material  point  qh  in  the  rigid  body  is  then  represented  in  the  inertial  frame 
as  qr  =  Rqb  where  R  is  an  element  of  SO{ 3),  the  special  orthogonal  group 
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of  3  x  3  matrices.  Hence  the  configuration  space  of  the  rigid  body  may  be 
identified  with  SO( 3),  the  velocity  space  with  the  tangent  bundle  TSO{ 3)  and 
the  momentum  phase  space  with  the  cotangent  bundle  T*SO( 3).  Let  bi,...bm 
be  the  axis  about  which  the  corresponding  control  torque  of  magnitude  ||6j||iXj 
is  applied  by  means  of  opposing  pairs  of  gas  jets.  The  dynamical  equations  for 
the  controlled  spacecraft  are  then  given  by 

R  =  RQ  (3.19-a) 

771 

IQ  =  IQ  x  biUi  (3.19-b) 

i= 1 

where  hi  =  (fli,  Q2:  Q3)  is  the  body  angular  velocity,  hi  is  a  3  x  3  skew  symmetric 
matrix  given  by 

0  —  Q3  Q2 

Q=  Q3  0  -fti 

-Q2  Qi  0 

and  /  =  diag(/i,  I2, 13)  is  the  inertia  matrix.  In  the  rest  of  the  discussion 
defines  a  map  T  R3  — )■  so(3),  such  that  af3  =  a  x  (3,  a,/3  G  IR3.  Thus 

0  — ct3  cl2 

CX3  0  — OL 1 

— ol2  0 

3.2.1  Symmetry  and  Reduction 

The  Lagrangian  L  :  TSO( 3)  — >  IR  is  again  simply  the  kinetic  energy  and  is  given 
by 

L(R,R)  =  - <Q,  IQ  > 

2 
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and  the  corresponding  Hamiltonian  H  :  T*SO( 3)  — »  1R,  is  given  by 

\  <  n,/_1n  > 

where  n  =  /Q  is  the  body  angular  momentum.  Observe  that  the  tangent  lift  of 
g  =  R  E  SO( 3)  on  TSO{ 3)  dehned  as 

TL9  :  TSO(3)  ->■  TSO{3) 

(R,  i?)  i — ^  (RR,  RR^T) 

leaves  the  Lagrangian  (and  hence  also  the  Hamiltonian)  invariant.  Hence  one 
can  induce  a  Hamiltonian  on  the  quotient  space,  T*SO(3)/SO(3),  and  express 
the  dynamics  in  terms  of  the  appropriate  reduced  variables.  The  quotient  space 
T* SO(3) / SO(3)  is  isomorphic  to  so(3)*,  the  dual  of  the  Lie  algebra  of  SO (3)  and 
the  reduced  variables  are  n  =  (ni,n2,n3)  corresponding  to  the  body  angular 
momentum.  Choosing 

000  001  0  -10 

Xi=  00-1  ,  x2=  o  00  ,^3=  1  0  0 

010  -1  00  000 
as  a  basis  of  so(3)  and  with  the  commutation  relations  [Xi,  X2]  =  X3,  \ X:> .  X\  = 
X2  and  [X3,  X2]  =  —Xi,  the  Lie-Poisson  bracket  of  two  differentiable  functions 
G,  H  on  so(3)*  is  given  by 

{G,  H}_( y)  =  XGTA(g)VH  (3.20) 

where  g  =  (n1,n2,n3)  G  so(3)*  and 

0  — n3  n2 

a  =  n3  0  —n! 

— n2  nx  0 
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The  reduced  equations  take  the  form 


II  —  /( II)  +  +  biUi  (3-21) 

1=1 

where  /(II)  =  (I^U2U3,  ^f^II2n3,  bi  =  RTbi.  Depending  on  the 

control  authority  and  material  symmetry  (with  respect  to  the  principal  axes)  we 
distinguish  between  the  following  two  versions 

Case  1:  Axisymmetric  Spacecraft:  Assuming  that  we  have  only  one  control 
and  I\  =  I2l  then  (3.21)  can  be  written  as 


rii  =  {I\  /3)n 2n3  +  cm 

t  d3 

ri2  =  -(Jl~/3)n1n3  +  ^ 

ll3  =  7  u 


(3.22) 


Case  2:  Asymmetric  Spacecraft:  Assuming  that  f  /  I2  /  /3  and  two  pure 
torques  are  available  as  controls,  the  reduced  dynamics  are  given  by 


rii 

ri2 

ri3 


h  —  h  T-r  -rj  . 

- -T~r - n2n3  +  U\ 

3r  T  1n2n3  +  u2 

I  ih 


h~h 

hh 


niii2 


(3.20) 
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3.3  Autonomous  Underwater  Vehicle 


In  this  section  we  discuss  the  reduced  space  dynamics  of  a  neutrally  buoyant 
underwater  vehicle.  We  distinguish  between  the  cases  of  coincident  and  nonco¬ 
incident  centers  of  buoyancy  and  gravity.  The  Lie-Poisson  dynamics  for  these 
cases  have  been  derived  in  [Lamb,  1945;  Birkhoff,  1960;  Leonard,  1995].  We  only 
present  a  brief  overview  of  the  Lie-Poisson  dynamics. 


3.3.1  Non  Coincident  Center  of  Mass  and  Center  of  Buoy¬ 
ancy 


Let  {e?1 ,  er2,  ef  }  be  an  inertial  frame  of  reference  (see  Figure  3.3)  fixed  at  O  and 
{eb,  eb,  e|}  be  a  body  frame  fixed  on  the  vehicle  at  its  center  of  buoyancy  (CB). 
A  material  point  qb  in  the  underwater  vehicle  is  then  represented  in  the  inertial 
frame  as  qr  =  Rqb  +  r  where  R  is  an  element  of  SO( 3),  the  special  orthogonal 
group  of  3  x  3  matrices  and  r  =  (x,  y,  z )  is  a  vector  from  O  to  the  center  of 
buoyancy  (CB).  Hence  at  any  instant,  the  configuration  X(t')  of  the  underwater 
vehicle  can  be  uniquely  identified  by  the  pair  (R,  r )  or  equivalently  as  an  element 
of  SE( 3),  the  Special  Euclidean  group  of  3  x  3  matrices.  Recall 


SE(  3)  =  { 


R  r 
0  1 


R  G  SO(3),r  G  R3}. 


While  deriving  the  dynamics  we  assume  that  the  underwater  vehicle  is  submerged 
in  an  infinitely  large  mass  of  incompressible,  inviscid  fluid.  Further,  we  assume 
that  the  flow  is  irrotational  (the  motion  of  the  fluid  is  entirely  due  to  that  of 


49 


Figure  3.3:  Autonomous  Underwater  Vehicle 

the  underwater  vehicle).  Under  these  assumptions  the  motion  of  the  fluid  can 
be  characterized  by  the  existence  of  a  single- valued  potential  0  which  satisfies 

=  0 

=  0  at  infinity 

=  n  ■  (v  +  x  rb)  at  body  surface, 

where  rb  is  a  vector  from  the  CB  to  the  vehicle’s  surface,  n  is  the  unit  outward 
normal  vector  of  the  vehicle,  hi  =  (f^,  02,  f^3)T  are  the  body  angular  velocities, 
and  v  =  (vi,V2,Vs)t  are  the  linear  velocity  components  along  the  body-fixed 
frame.  Under  these  assumptions  Kirchhoff  showed  that 

0  =  ^101  +  ^202  +  ^303  +  ftiXi  +  ^2X2  +  ^3X3  (3-21) 

where  0  1,  02,  03,  Xi,  X2,  X3  are  functions  of  x,  y:  z  determined  by  the  configuration 
of  the  surface  of  the  solid.  Using  the  form  of  0  as  expressed  in  (3.21,  the  kinetic 


V20 

V0 

dcj) 

dn 
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energy  of  the  fluid 


Tf  ~  0P0 


where  po  is  the  fluid  density,  can  be  expressed  as  a  quadratic  form 

@11  @12 

@21  @22 

W  =  {vT ,  rtT)T,  ©n  is  referred  to  as  the  added  mass  matrix,  022  as  the  added 
inertia  matrix,  ©i2  and  ©2i  account  for  cross  terms  (c.f.  [Lamb,  1945;  Birkhoff, 
I960]). 


Tf  =  -W1  GW,  0  = 

A 


The  kinetic  energy  of  the  vehicle  alone  can  be  expressed  as 


Tb  = 


-WTIW  I 
2 


ml  —mrg 
mrg  Jb 


where  I  is  the  3x3  identity  matrix,  m  is  the  mass  and  Jb  is  the  inertia  matrix. 
Hence  the  total  kinetic  energy  can  be  expressed  in  a  quadratic  form  as 

T  =  -WT(I  +  0)VL  =  -(SdTJSd  +  2QtDv  +  vtMv) 

2  2 


J  =  J6  +  @n,  D  =  tyiVt g  T  @12  and  M  =  ml  +  @22  (I  is  the  3x3  identity  matrix). 

Assume  that  the  center  of  gravity  (CG)  does  not  coincide  with  the  center  of 
buoyancy  (CB)  and  lies  on  the  e\  axis  at  a  distance  l  >  0  (bottom  heavy)  from 
the  CB,  i.e,  rg  =  li3  where  i3  denotes  a  unit  vector  (in  body  coordinates)  along 
the  e\  axis.  Also  let  ig  denote  a  unit  vector  (in  inertial  coordinates)  in  the 
direction  of  gravity,  i.e.  along  the  axis.  Let  m  be  the  mass  of  the  vehicle  and 
Jb  the  inertia  matrix  for  the  vehicle.  The  moment  applied  to  the  body  due  to 
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gravity,  expressed  in  body  coordinates  is  given  by 


rg  x  RTmgig  =  —mgl(T  x  i3) 

where  T  =  RTig 

The  Lagrangian  L  :  TSE( 3)  — »  R  is  then  given  by 

L(R ,  r,  R ,  r)  =  -(ffT  JT2  +  2Vlr  Dv  +  vT Mv  +  2 mgl{ig.Ri3)) 

2 

The  potential  2mgl(ig.Ri3 )  accounts  for  the  moment  contribution  due  to  nonco¬ 
incident  center  of  mass  and  center  of  buoyancy.  In  the  rest  of  the  discussion  the 
underwater  vehicle  is  approximated  as  an  ellipsoid  and  hence  ©12  =  ©21  =  0. 

It  can  be  shown  that  the  impulse  of  the  body-fluid  system  varies,  in  consequence 
of  extraneous  forces  acting  on  the  solid,  in  exactly  the  same  way  as  the  momen¬ 
tum  of  a  finite  dynamical  system.  In  the  case  of  coincident  center  of  mass  and 
center  of  gravity  these  equations  were  derived  by  [Lamb,  1945]  and  in  the  Lie 
group  setting  as  early  as  1943  by  Birkhoff  [Birkhoff,  I960].  The  observation  that 
the  reduced  dynamics  for  the  the  noncoincident  center  of  mass  and  buoyancy  are 
of  the  “Lie-Poisson”  type  was  made  in  [Leonard,  1995].  The  reduction  procedure 
discussed  in  [Leonard,  1995]  is  briefly  outlined  here.  This  system  has  a  sufficient 
amount  of  complexity,  and  serves  as  a  challenging  example  for  application  of 
controllability  and  stabilization  results  derived  in  later  chapters. 

3.3.2  Newton-Euler  Balance  Laws 

Let  p  and  7r  be  the  linear  and  angular  components  of  the  impulse  with  respect 
to  the  inertial  coordinates.  Again  let  P  and  II,  the  convected  variables,  denote 
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the  components  along  the  body  hxed  frame.  Then 


p  =  RP  (3.22) 

7r  =  i?II  +  r  x  p  (3.23) 

Let  us  assume  that  an  external  force,  f[  and  torque  rt  ,  given  in  inertial  coordi¬ 
nates,  are  applied  to  the  body.  Let  pi  be  the  vector,  in  inertial  coordinates,  from 

the  origin  of  the  inertial  frame  to  the  point  on  the  line  of  action  of  the  force  /) . 

Then  from  Newton-Euler  balance  laws  we  have 


P  =  f  (3.24) 

7r  =  r  +  T^pi  x  fi  (3.25) 


Differentiating  p  and  7r  and  expressing  (3.24  -  3.25)  in  terms  of  convected  vari¬ 
ables  we  have 

k 

P  =  Pxfl  +  R^fi  (3.26) 

1=1 

fi  =  nxfi  +  Pxu  -  mgl(T  x  i3)  (3.27) 

k 

+  J^(i?T(pi  -  r))  x  Rt fi(t)  +  Rtt 
1=1 

f  =  r  x  n  (3.28) 

where  P  and  II  can  be  computed  from  the  total  energy  T  as 


P 

n 


dT 

dv 

dT 


Mv  +  DTn 
Jfl  +  Dv 


(3.29) 

(3.30) 
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3.3.3  Symmetry  and  Reduction 


Observe  that  the  Lagrangian  is  invariant  under  the  action  of  the  group 

G  =  {(R,r)e  SE( 3)  |  RTig  =  ig}  =  SE{ 2)  x  R. 

and  hence  the  Hamiltonian  system  on  T*SE( 3)  (which  is  also  left-invariant  under 
the  action  of  SE{2)  x  R)  can  be  reduced  to  a  Hamiltonian  system  on  s*,  the  dual 
of  the  Lie  algebra  of  the  semi-direct  product  S  =  SE[3)  xp  R3  (see  [Leonard, 
1995]  for  details).  The  reduced  Hamiltonian  on  s*  is 

H{ n,  P,  r)  =  \(nTAU  +  2n tBtP  +  PTCP  -  2mgl(T  ■  i3 )), 

where 


A  =  (J-  DM~1Dt)-1,  B  =  -CDtJ-\  C=(M-DtJ~1D)-1, 
n  =  Jfl  +  Dv,  P  =  Mv  +  DtQ,  and  T  =  RTig. 


Choosing 


Ai 

0 

0  &i— 6 

B,  = 

,  i  =  1,.. 

.,6,  Bi  = 

0 

0 

0  0 

where 


Ai 


et  0 

0  0 


i  =  l,  2, 3  Ai 


0  e% 

0  0 


and  i  =  4,  5,  6 


as  a  basis  for  S  the  Lie  algebra  of  S.  The  Lie-Poisson  bracket  of  two  differentiable 
functions  G ,  H  on  s*  is  given  by 


{G,  #}_(//)  =  VGtA(/t)V1L 
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where  /*  =  (II,  P,  T)  and 


n  P  f 

A=  POO  • 

f  0  0 

The  Lie-Poisson  reduced  equations  (see  [Leonard,  1995]  for  a  complete  descrip¬ 
tion  of  reduction  procedure)  are  then  given  by 

Ah  =  {A 

or  explicitly  as 


fl  =  n  x  (An  +  BtP )  +  Px  (CP  +  BU)  -  mglT  x  i3 
P  =  P  x  (An  +  BtP )  (3.31) 

f  =  r  x  (An  +  btp) 


3.3.4  Coincident  Center  of  Mass  and  Center  of  Buoyancy 


In  the  case  of  coincident  center  of  gravity  and  center  of  buoyancy  (i.e.  1  =  0), 
D  =  0  and  hence  the  Lagrangian  is  given  by 

l  =  -(nTrn  +  vTMv). 

Hence  the  Hamiltonian  system  on  T*SE( 3)  is  left  invariant  under  the  SE( 3) 
action  of  rotations  and  translations,  and  we  can  derive  a  set  of  reduced  Lie- 
Poisson  equations  on  se(3)*.  Choosing 


/  n  \ 

0  ei 

*  =  1,2,3  Ai  =  ,  *  =  4,5,6 

V°  0 
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as  the  basis  for  se(3)  the  structure  matrix  [A (n)\ij  =  —  Y^i=i  is  given  by 

n  P 

A(/r)  =  A(n  ,P)=  ^ 

P  0 

where  II  =  Jfl  and  P  =  Mv.  The  Lie-Poisson  reduced  equations  are  given  by 

n  =  n  x  (An)  +  p  x  cp  (3.32-a) 

P  =  P  x  An  (3.32-b) 

3.4  Ships:  Partially  Submerged  Floating  Bod¬ 
ies 

In  this  section  we  study  motions  of  ships  in  incompressible,  and  inviscid  fluid 
in  the  absence  of  waves.  While  ship  motions  arise  very  rarely  in  quiet  water, 
there  is  a  great  practical  value  in  their  study  since  the  characteristics  of  ships  in 
agitated  seas  are  governed  by  the  characteristics  of  motion  in  quiet  water. 

As  in  the  case  of  the  underwater  vehicle  we  identify  the  configuration  space  of 
a  ship  with  the  Lie  group  SE( 3).  Let  {e^e^eg}  denote  the  inertial  frame  of 
reference  and  let  {e|,  eb,  e|}  denote  the  body-fixed  frame  attached  to  the  center  of 
mass  as  shown  in  Figure  3.4.  Note  that  unlike  the  underwater  vehicle  the  body- 
fixed  frame  is  attached  to  the  center  of  mass  of  the  vessel  as  opposed  to  the 
center  of  buoyancy.  Any  material  point  with  body  coordinates  qb  =  (xj,,  y, &,  zp  is 
then  represented  in  inertial  coordinates  by  qr  =  Rqb  +  r,  where  R  G  SO (3)  and 
r  =  (x,  y,  z )  describes  the  position  of  the  center  of  mass  in  inertial  coordinates. 
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Figure  3.4:  A  floating  body  in  equilibrium 

Remark  3.4.1  To  simplify  calculation  one  normally  makes  the  following  as¬ 
sumptions  - 

(i)  There  is  a  vertical  plane  of  symmetry  about  which  the  vessel  is  symmetric 
with  respect  to  its  shape  and  mass  distribution. 

(ii)  The  longitudinal  axis  of  symmetry  is  directed  horizontally. 

These  assumptions  completely  determine  the  principal  axes  of  inertia  of  the 
vessel.  Further  the  body  fixed  frame  is  chosen  along  the  principal  axis,  such  that 
in  equilibrium  e\  is  directed  towards  the  bow,  eh2  to  starboard  and  e\  downwards. 

A  floating  vessel  in  equilibrium  experiences  only  two  forces:  gravitational  force, 
acting  vertically  downwards  at  the  center  of  mass,  and  a  buoyant  force,  equal 
to  the  weight  of  the  volume  of  water  displaced  by  the  submerged  part,  acting 
vertically  upward  at  the  center  of  buoyancy  (centroid  of  the  of  the  submerged 
volume).  These  forces  are  equal  and  opposite  in  direction  and  their  points  of 
application  he  on  a  single  vertical  line.  Let  us  assume  that  the  center  of  buoyancy 
of  the  vessel  in  equilibrium  lies  along  e\  at  a  distance  a  from  the  center  of  mass. 
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Hence  in  body  fixed  coordinates,  the  center  of  buoyancy  in  equilibrium  is  given 
by  Qcb  = 


Let  (fii,fi2,n3)  denote  the  body  angular  velocities  and  v  =  (iq,  u2,  v^)T  denote 
the  linear  velocity  components  along  the  body  fixed  frame,  i.e.  v  =  RTr.  The 
kinematics  are  then  given  by 

r  =  m 

r  =  Rv 


As  in  the  case  of  the  underwater  vehicle  the  kinetic  energy  (KE)  of  the  body 
plus  fluid  is  given  by 


KE 


KE, 


body 


KEfluid  =  \wTlbodyW  + 


fluid 


w1 


In  (3.33) 


and 


I 


body 


ml  0 

0  Jb 


I  fluid, 


©11  @12 
@21  @22 


(3.33) 


(3.34) 


(3.35) 


©n  is  referred  to  as  the  added  mass  matrix,  @22  the  added  inertia  matrix.  ©i2  = 
©22  account  for  cross  terms.  Hence  the  total  kinetic  energy  can  be  expressed  in 
quadratic  form  as 


J 


T  =  -WT(I  +  0)W  =  +  2QtDv  +  vtMv ) 

2  2 

Jb  +  @n,  D  =  ©i2  and  M  =  ml  +  ©22  (I  is  the  3x3  identity  matrix). 
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Remark  3.4.2  In  the  case  of  the  underwater  vehicle  I  fluid,  is  calculated  with 
respect  to  the  body  frame  of  reference  attached  to  the  center  of  buoyancy.  As¬ 
suming  an  incompressible,  irrotational  fluid,  at  rest  at  infinity  it  was  shown  that 


[I fiuidlij  =  £ij  =  l  //  {4>j.n)ds  (3.36) 

J  J  Asub 

where  the  velocity  potential  </>  was  given  by  Kirchhoff  as 

=  V\(f)\  +  V\4>2  +  Ui03  +  +  ^306 

and  n  is  the  normal  vector  at  any  point  on  the  surface  directed  into  the  body. 
Since  in  the  case  of  a  partially  submerged  fluid  only  a  part  of  the  body  is 
below  the  surface  this  approach  to  calculating  the  the  fluid  inertia  matrix  is 
not  entirely  valid.  However  is  has  been  shown  [Newman,  1992;  Fossen,  1994; 
Balgoveshchensky,  1962]  that  using  imaging  methods  a  similar  approach  can  be 
adopted  to  calculate  1  fluid-  This  approach  assumes  that  the  the  added  mass  for 
a  vessel  floating  on  the  surface  of  water  equals  half  that  of  a  body  entirely  sub¬ 
merged  in  a  fluid  of  infinite  extent,  and  having  the  shape  of  the  the  submerged 
portion  doubled.  I  fluid  is  calculated  w.r.t  the  point  of  intersection  of  the  water¬ 
line,  the  longitudinal  plane  of  symmetry  and  the  middle  frame  and  transformed 
to  body  coordinates  attached  to  the  center  of  mass.  Secondly  it  is  assumed  that 
the  flow  over  the  sides  of  the  vessel  is  two  dimensional,  the  so  called  plane  of 
flow  hypothesis.  According  to  these  hypotheses,  the  computation  of  the  added 
mass  per  unit  length  of  the  vessel  may  be  performed  for  each  section  as  for  an 
infinitely  long  cylinder  moving  in  a  direction  perpendicular  to  its  axis  and  having 
the  same  cross-sectional  shape  as  the  doubled  frame.  The  results  of  these  com¬ 
putations,  performed  for  each  frame,  independent  to  its  neighbor  are  integrated 
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over  the  length  of  the  vessel. 


3.4.1  Newton-Euler  Balance  Laws 


The  gravitational  force  (expressed  in  body  coordinates)  acting  on  the  vessel  is 
given  by 

Fg  =  RT(mgk),  (3.37) 

where  k  is  a  unit  vector  in  the  direction  of  gravity  i.e  along  positive  e\. 


The  hydrostatic  force  expressed  in  body  coordinates  is  given  by 


hydro 


=  ~RT{P9 


n[z 


n)ds) 


(3.38) 


ASub 

where  z  —  n  denotes  the  depth,  in  inertial  coordinates,  of  a  point  on  the  surface 
of  the  submerged  part.  Here,  the  normal  vector  n  is  taken  to  be  positive  when 
pointing  out  of  the  fluid  volume  and  hence  into  the  body,  and  p  is  the  fluid 
density.  Applying  Gauss’s  theorem  to  (3.38)  yields 


Fh.ydro  =  -pg  HI  V(z-  n)dV  =  ~^Vsubk  (3.39) 

VSub 

where  Vsub  denoted  the  instantaneous  volume  enclosed  by  the  water  plane  and 
the  submerged  body  surface.  Hence  the  net  external  force  acting  on  the  vessel 
is  given  by 

Fext  =  FLT (mg  -  ^Vsub)k  (3.40) 


To  calculate  the  moment  due  to  the  external  force  observe  that  the  moment 
about  the  center  of  mass  due  to  the  force  of  gravity  is  zero.  The  moment  due  to 
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the  hydrostatic  force  about  the  center  of  mass  is  given  by 


■M  hydro  =  J  J  J  (lb  X  RTk^dV  (qb) 

VSub 


(3,41) 


Let  Vsub  =  Vo  +  A V(R,r),  where  Vo  denotes  the  volume  of  the  submerged  part, 
when  the  vessel  in  equilibrium.  Since  in  equilibrium  the  net  force  on  the  body 
is  zero,  i.e.  mgk  =  yVok,  (3.40)  and  (3.41)  can  be  written  as  follows. 


Fext  =  RT {mg  -  7Vs«.ft)k 

=  RT  (mg  —  7V0  —  7AV)k 
=  -('yAV)RT-k 


(3.42) 

(3.43) 

(3.44) 


and 


M- hydro  =  — 7-RTk  x  JJjqbdV(qb)  (3.45) 

Vsub 

=  — 7-RTk  X  JJJ  qbdV(qb)  -  jRTk  X  JJJ  qbdV(qb )  (3.46) 

Vo  AV 

=  — 7Vr0i?Tk  x  q°cb  —  jRTk  x  JJJ  qbdV (qb).  (3.47) 

AV 


Hence  from  the  Newton-Euler  balance  laws  we  have 


r  = 

Rv 

(3.48) 

0  = 

Rtt 

(3.49) 

P  = 

Pxfl  -  (7A  V)Rt  ■  k 

(3.50) 
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fl 


7 TXtt+PXV+ 
—"/V0RTk  x  q°cb  —  7-RTk  x 


JJJ  qbdV(qb ) 

av 


where  II  =  |^  =  and  P  =  . 


(3.51) 

(3.52) 


3.5  Symmetry  and  Reduction 

Observe  that  the  the  kinetic  energy,  hydrostatic  forces  and  the  forces  due  to 
gravitation  are  SE( 2)  invariant,  i.e.  are  invariant  to  translations  in  the  e[e2 
plane,  and  rotations  about  an  axis  perpendicular  to  this  plane.  Hence  the  dy¬ 
namics  can  be  reduced  from  T*SE( 3)  to  s*  =  T* SE(3) / SE(2).  While  writing 
down  the  reduced  dynamics  in  this  case  we  observed  that  unlike  the  autonomous 
underwater  vehicle,  we  could  not  express  the  buoyant  force  as  a  potential  and 
hence  the  reduced  dynamics  could  not  be  written  down  as  a  Hamiltonian  system 
on  s*. 

Choosing  coordinates  (z,  T,  P,  n),  with  T  =  RT k  we  now  write  down  the  reduced 
dynamics. 

Observe  that,  ||r||  =  1, 

T  =  -Or  (3.53) 

=  T  x  O  (3.54) 

and 

z  =  Rv  ■  k  (3.55) 

=  k T  Rv  (3.56) 
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=  Pv 

=  v  ■  r 

The  reduced  dynamics  on  T* S E(3) / S E(2)  are  then  given  by 

(3.57) 

(3.58) 

z 

=  v-T 

(3.59) 

f 

=  r  x  n 

(3.60) 

P 

=  p  x  n  +  7a  vt 

(3.61) 

n 

=  UxQ  +  Px  V  +  V0(rxq°cb)+'yJJJrxqbdqb 

(3.62) 

av 


Where  AV"  =  AV(r,  z)  denotes  the  change  in  submerged  volume  expressed  as  a 
function  of  T  and  z. 
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Chapter  4 


Controllability  of  Lie  Poisson  Reduced 
Dynamics 


As  seen  in  Chapter  3  the  state  space  of  a  large  class  of  mechanical  systems  such 
as  hovercraft,  spacecraft  underwater  vehicle  etc.  can  be  identified  with  a  Lie 
group  G.  The  Hamiltonian  dynamics  (defined  on  T*G)  of  these  systems  subject 
to  external  forces  can  be  written  in  the  form  of  a  control  system  as 

m 

x  =  f(x)  +  ^gi(x)Ui  (4.1) 

i=l 

where  x  G  T*G,  f(x )  =  XH  and  u  =  (tti, . . .  um ).  ( H  is  the  Hamiltonian  defined 
on  T*G ).  The  G'-in variance  of  (4.1)  allows  us  to  drop  the  the  vector  fields  /  and 
g'-s  from  T*G  to  T*G/G  —  g*  and  the  reduced  dynamics  take  the  form 

m 

A  =  f(p)  +  9i(n)ui  (4-2) 

i= 1 

where  g  G  g*,  /  and  gi  are  the  projections  of  /  and  g  on  T*G/G.  From  the 
discussion  in  chapter  2  (cf.  Proposition  2.2.3)  we  know  that  f  =  Xg  where  H  is 
the  reduced  Hamiltonian  and  Xg  is  Hamiltonian  with  respect  to  the  Lie-Poisson 
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structure  defined  on  g*.  Studying  controllability  of  systems  of  the  form  (4.2)  or 
of  more  general  systems  of  the  form 


x  =  f(x)  +  ^2  9i(x)ui,  X  E  Rn,  u  =  (ui, . . .  um)  E  U  (4.3) 

i= 1 

is  usually  a  hard  problem.  We  know  that  if  a  system  of  the  form  (4.3)  satis¬ 
fies  the  Lie  algebra  rank  condition  (LARC)  then  it  is  locally  accessible,  and  in 
addition  if  /  =  0  then  LARC  implies  that  the  system  is  controllable,  (cf.  Theo¬ 
rem  2.3.10).  While  the  kinematic  equations  of  motion  can  often  be  written  as  a 
drift-free  system,  once  dynamics  are  included  LARC  does  not  imply  controllabil¬ 
ity.  Proving  controllability  is  usually  much  harder  than  proving  accessibility.  In 
[Crouch  and  Byrnes,  1986]  sufficient  conditions  are  given,  in  terms  of  a  “group 
action”,  that  a  locally  accessible  system  is  also  locally  reachable.  In  [Lobry,  1974] 
sufficient  conditions  for  the  controllability  of  a  conservative  dynamical  polysys¬ 
tem  on  a  compact  Riemannian  manifold  are  presented.  More  recently  this  result 
was  extended  by  [Lian  et  al. ,  1994]  to  dynamical  polysystems  where  the  drift 
vector  held  was  required  to  be  weakly  positively  Poisson  stable.  We  extend 
this  result  to  reduced  dynamics  where  the  drift  vector  held  is  Lie-Poisson.  We 
prove  conditions  under  which  the  reduced  dynamics  are  controllable.  Before  we 
present  our  results  we  introduce  some  definitions  and  related  theorems  regarding 
Poisson  stable  systems.  We  follow  the  development  in  [Lian  et  al.,  1994;  Nijmei- 
jer  and  van  der  Schaft,  1990;  Dayawansa,  1994;  Arnold,  1989;  Brockett,  1976; 
Nemytskii  and  Stepanov,  I960]. 
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4.1  Poisson  Stability  and  Controllability 

Let  X  be  a  smooth  complete  vector  field  on  M  and  let  Xt  (:  )  denote  its  flow. 

Definition  4.1.1  A  point  pG  Mis  called  positively  Poisson  stable  for  X  if  for 
all  T  >  0  and  any  neighborhood  Vp  of  p.  there  exists  a  time  t  >  T,  such  that 
4>?(p)  G  Vp.  The  vector  field  X  is  called  positively  Poisson  stable  if  the  set  of 
Poisson  stable  points  for  X  is  dense  in  M. 

Definition  4.1.2  A  point  p  G  M  is  called  nonwandering  point  of  X  if  for  all 
T  >  0  and  for  any  neighborhood  Vp  of  p.  there  exists  a  time  t  >  T  such  that 
<l>?(yp)  D^0,  where  <${VP)  =  {<ff(q)  \  q  G  Vp}. 

One  should  observe  here  that  though  the  positive  Poisson  stability  is  a  sufficient 
condition  that  the  nonwandering  set  of  a  positively  Poisson  stable  vector  field 
is  the  entire  manifold  M ,  there  could  exist  weaker  conditions  under  which  the 
nonwandering  set  is  M.  This  gives  rise  to  the  definition  of  a  weakly  positively 
Poisson  stable  (WPPS)  vector  field. 

Definition  4.1.3  The  vector  field  X  is  called  weakly  positively  Poisson  stable 
if  the  associated  nonwandering  set  is  M. 

The  following  theorem  on  controllability  of  nonlinear  affine  control  systems  where 
the  drift  vector  field  is  WPPS  is  due  to  [Lian  et  ai,  1994],  Earlier  versions  of 
this  theorem  and  the  corollary  that  follows,  where  the  hypothesis  required  /  to 
be  only  Poisson  Stable,  are  due  to  Lobry  [Lobry,  1974],  Bonnard  and  Crouch 
[Crouch  et  al,  1980]. 
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Theorem  4.1.4  If  the  system 


X  =  f(x)  +  ^2  9i{X)Ui,  U  =  (ui,  .  .  .  Um)  G  U  C  I” 

i— 1 

where  U  contains  {u  \  \ui\  <  Mi  ^  0,i, . . .  ,m}  is  such  that  f  is  a  weakly  posi¬ 
tively  Poisson  stable  vector  field,  then  the  system  is  controllable  if  the  accessibility 
LARC  is  satisfied. 

Before  we  present  the  proof  of  the  theorem  (presented  in  [Lian  et  al,  1994]) 
we  present  the  following  theorem  by  [Jnrdjevic  and  Knpka,  1981;  Hermes  and 
LaSalle,  1969]  which  will  be  used  in  the  proof. 

Theorem  4.1.5  Let  IF  be  a  dynamical  polysystem.  Then 

cl(R(lF,p))  =  cl(R(conv(IF),p )),  Vp  G  M 

Here  conv(-)  and  cl(-)  denote  the  convex  hull  and  closure  respectively. 

Proof:  (of  Theorem  4.1.4)  If  the  dynamical  system  is  controllable  then 

LARC  is  satisfied.  This  follows  from  Theorem  2.3.4.  The  “if”  part  (WPPS 
+  LARC  Controllability)  is  proved  as  follows.  Let  £  =  JT(J{ — /}  and 
let  C{£)  denote  the  Lie  algebra  generated  by  £.  Since  LARC  is  satisfied, 
span£(£)(p)  =  span£(conv(£))(p)  =  TpM.  While  conv(£)  is  not  symmetric, 
in  the  sense  of  Definition  2.3.9  it  satisfies  the  property  that  for  every  Xt  e 
£,—ctiXi  £8  a.i  G  (0,1].  From  a  slight  modification  of  the  controllabil¬ 
ity  proof  1  for  symmetric  systems  presented  in  [Nijmeijer  and  van  der  Schaft, 

1  “he  entuition  being  yhat  yhe  tffect  If  ilowing  tlong  yhe  vector  iield  X  ior  yirne  t  =  T  can 
be  tchieved  by  ilowing  tlong  yhe  vector  iield  aX  ior  yime  t  =  T / aP 
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1990]  it  follows  that  _R(conv(£,p))  =  M,Vp  £  M.  From  Theorem  4.1.5  it  fol¬ 
lows  that  cl (R(£,p))  =  M,\/p  £  M.  Since  span£(£)(p)  =  span£(— £)(p)  = 
Tp(M),  R(—£,  y )  has  a  non  empty  interior  for  all  y  £  M.  Hence  for  any  q  £  M 
there  exists  some  point  in  int(i?(— £,  q))  p|  R(£,p).  This  implies  q  £  R(£,p). 
Hence  R(£,p)  =  M  Vp  £  M. 


Let  p  £  int (i?(— JF,  g))  and  in  £  int(i?(JF, p)).  Since  R(£,w )  =  M,\/w  £  M, 
there  exists  an  integral  curve  of  5  joining  w  to  i.e. 

3ti , ,tk  >  0  and  Ah , . . . ,  Ah  £  £ 


such  that 

If  Xi,i  =  1, . . . ,  k  belong  to  JF,  then  q  £  i?(jF,p).  If  there  are  some  Ah’s  such 
that  Xi  =  — /  £  £,  then  one  exploits  the  WPPS  property  of  /  to  correct  this. 
Without  loss  of  generality  assume  that  Xi  =  —f.  A  neighborhood  Uz  of  z,  can 
be  found  in  the  interior  of  R(—J-,  q)  such  that 

«'  o  . . .  o  *£*)- ‘(C/J  c  int (R(T,p))  (4.4) 

with  w  e  ( 1  o  •  ■  ■  o 


The  WPPS  of  the  vector  held  /  implies  that  for  and  H  there  exists  Tj  >  H 
such  that  <pTl(Uz)  fj  Uz  ^  0.  Accordingly  there  exist  £,£  £  [F,  C  int(i?(— JF,  q)), 
such  that  £  =  </>£  (£).  From  (4.4)  we  can  hnd  s  £  int  (i?(.F,p)),  with  £  = 
°  ■■■°(t>fLk{s).  Thus 

£  =  0Ti  °  °  •  •  •  °  4>fkk  (s)  =  0T,-*!  °  •  •  •  °  4>fkk  (s). 

Since  £  £  int(i?(— T,  q))  and  s  £  int  (i?(.F,p))  it  follows  that 

q  =  (f)T  o  (j)fTi  ti  o  •  •  •  o  o  <^(p) 
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where  (j^'s  denote  some  flow  of  T .  Other  possible  —f  can  be  treated  in  a  similar 
way.  Hence  arbitrary  q  can  be  reached  from  any  p  by  some  integral  curve  of  T . 


As  shown  in  [Crouch  et  al,  1980]  controllability  can  be  achieved  by  restricting 
the  controls  to  the  discrete  set  U  =  {—1,  Ill- 

Corollary  4.1.6  If  the  system 

m 

X  =  f{x)  +  ^2  9i{x)uii  U  =  («1,  ...Um)eU 

2=1 

is  such  that  f  is  a  weakly  positively  Poisson  stable  vector  field,  and  accessi¬ 
bility  LARC  is  satisfied,  then  the  system  with  controls  constrained  by  Ui  G 
{—Mi,  Mi},  Mi  >  0,  i  —  1, . . . ,  m  is  controllable. 


4.2  Controllability  of  Reduced  Dynamics 

A  natural  question  that  arises  is  whether  is  there  is  a  sufficiently  large  class  of 
vector  fields  that  are  WPPS.  In  the  setting  of  Hamiltonian  vector  fields  on 
bounded  symplectic  manifolds  this  question  is  answered  by  the  Poincare  recur¬ 
rence  theorem  [Arnold,  1989;  Nemytskii  and  Stepanov,  I960]  stated  below. 

Theorem  4.2.1  Let  if  be  a  volume-preserving  continuous  bijective  map  on  a 
bounded  region  D  onto  itself.  Then  in  any  neighborhood  U  of  any  point  in  D, 
there  exists  a  point  x  G  U  which  returns  to  U  after  a  repeated  application  of  the 
mapping,  i.e.  ifn(x)  G  D. 
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Theorem  2.1.4  shows  that  Hamiltonian  vector  fields  on  symplectic  manifolds  are 
volume-preserving.  Hence,  if  in  addition,  the  flows  are  restricted  to  a  bounded 
set,  or  live  on  a  bounded  manifold,  then  it  follows  that  a  time-independent 
Hamiltonian  vector  field  on  a  bounded  symplectic  manifold  is  WPPS. 

As  is  easily  observed  from  the  dynamics  of  the  hovercraft  and  underwater  vehicles 
the  state  space  of  these  systems  is  not  a  bounded  manifold  and  hence  one  cannot 
easily  conclude  the  WPPS  nature  of  the  drift  vector  field  in  these  cases. 

In  the  setting  of  reduced  dynamics  where  the  drift  vector  field  is  Lie-Poisson  we 
can  make  the  following  observation. 

Theorem  4.2.2  Let  G  be  a  Lie  group  that  acts  on  itself  by  left  (right)  transla¬ 
tions.  Let  H  :  T*G  — >  R  be  a  left  (right)  invariant  Hamiltonian.  Then, 

(i)  If  G  is  a  compact  group,  the  coadjoint  orbits  of  g*  =  T*G/G  are  bounded  and 
the  Lie-Poisson  reduced  Hamiltonian  vector  field  Xg  is  WPPS. 

(ii)  If  G  is  a  noncompact  group  then  the  Lie-Poisson  reduced  Hamiltonian  vector 
field  Xg  is  WPPS  if  there  exists  a  function  V  :  g*  — *  R  such  that  V  (fi)  is  bounded 
below,  V(fx)  — *  oo  as  ||/r||  — >  oo  and  V  =  0  along  trajectories  of  the  system. 

Here  H  is  the  induced  Hamiltonian  on  the  quotient  manifold  g*  =  T*G/G  and 
{•,  •}-(+)  is  the  induced  minus  (plus)  Lie-Poisson  bracket  on  the  quotient  mani¬ 
fold  0*  =  T*G/G. 

Proof:  (i)  The  projection  A  :  T*G  — »  g7  is  a  Poisson  map,  and  the  Poisson 

manifold  g*_  is  symplectically  foliated  by  coadjoint  orbits,  i.e.  it  is  a  disjoint 
union  of  symplectic  leaves  that  are  just  the  coadjoint  orbits.  Any  Hamiltonian 
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system  on  0*1  leaves  invariant  the  symplectic  leaves  and  hence  restricts  to  a 
canonical  Hamiltonian  system  on  a  leaf.  To  study  the  dynamics  of  a  particular 
system  with  initial  condition  /r(0)  G  0*1,  we  therefore  restrict  attention  to  the 
coadjoint  orbit  through  /r(0).  By  hypothesis,  each  coadjoint  orbit  is  compact. 
The  flow  starting  at  //(())  preserves  the  symplectic  volume  measure  on  the  orbit. 
Hence  by  the  Poincare  Recurrence  Theorem,  we  know  that  for  almost  every  point 
p  G  gl  and  any  neighborhood  Vp  of  p  there  exists  a  time  t  >  T  such  that  4>?{p) 
returns  to  Vp  i.e.  Xg  is  WPPS. 

(ii)  Let  D  =  {p  \V(g)<  E},  and  let  Orb(-)  denote  the  coadjoint  orbit  through 
//(())  in  gl.  Then  the  integral  curve  of  Xg  starting  at  /i(0)  G  D  lies  entirely 
in  the  set  S  =  .DnOrb(-).  Since  S  closed  and  bounded  in  0*1,  it  is  compact  in 
Orb(-),  and  hence  as  before  Xg  is  WPPS.  ■ 

In  many  situations  the  function  H ^  =  H  +  <j)(Ci )  where  H  is  the  reduced  Hamil¬ 
tonian  and  Ci  a  Casimir  is  a  good  choice  for  V{-). 

Remark  4.2.3  In  our  present  setting  of  Lie-Poisson  reduced  dynamics,  WPPS 
conditions  in  Theorem  4.1.4  can  be  verified  whenever  the  hypotheses  of  The¬ 
orem  4.2.2  hold.  Once  WPPS  of  the  drift  vector  held  has  been  established 
Theorem  4.1.4  can  be  used  to  conclude  controllability. 

Remark  4.2.4  As  mentioned  in  Chapter  2,  often  the  dynamics  on  T*G  are  not 
invariant  under  the  whole  group  G.  but  some  subgroup  of  it.  In  such  situations 
it  might  be  possible  to  write  down  the  reduced  dynamics,  using  the  semidirect 
product  reduction  theorem  on  the  dual  of  the  Lie  algebra  of  a  different  group 
S  which  is  a  semidirect  product.  As  these  dynamics  on  s*  are  still  Lie-Poisson 
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(cf.  Theorem  2.1.12  and  the  reduced  dynamics  of  AUV  with  coincident  center 
of  mass  and  center  of  buoyancy  discussed  in  Section  3.3)  Theorem  4.2.2  still 
applies. 


Applying  the  above  results  to  the  examples  discussed  in  Chapter  2  we  have  the 
following  results. 


Proposition  4.2.5  The  jet-puck  dynamics  defined  by  (3.17)  are  controllable  if 
sin  (f  7^  0 . 


Proof:  We  first  show  that  LARC  is  satisfied.  To  show  that 


dim(span£{/)g})(p)  =  3,  Vp  G  se(2)* 


where  /  =  (P2n//,  —Pill//,  0)T  and  g  =  (a,  j3,  d(3)T,  observe  that 


det (g,  [[/, g\,g\,[[f, g),[[f, g],g]\) 


a 

2j(32 

-2^(l2a 

det 

(d 

-2  jpa 

— 2  jj/?3 

d(5 

0 

0 

4(®?V  +  a2) 

a  m4  , 

4  i 3  1 

'since  a2 

+  (d2  =  l) 

Hence  dim(span£{jg})(p)  =  3  Vp  G  se( 2)*  as  long  as  f3  =  sin  <f>  ^  0,  i.e.  as  long 
as  the  line  of  action  of  P  does  not  pass  through  the  center  of  mass. 


We  observe  that  the  reduced  Hamiltonian 


H 


21 


n2  + 


\\Pf 

2  m 


(4.5) 
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Figure  4.1:  Energy  surface  and  coadjoint  orbits  in  se( 2)* 

is  bounded  below,  radially  unbounded  and  is  such  that  H  =  0.  Hence  it  follows 
from  Theorem  4.2.2  that  /  is  WPPS  and  hence  from  Theorem  4.1.4  we  conclude 
that  the  jet-puck  dynamics  are  controllable.  ■ 

In  fact  one  observes  that  every  orbit  of  /  is  periodic  and  hence  trivially  Poisson 
stable. 

Remark  4.2.6  Observe  that  the  coadjoint  orbits  in  .se(2)*  are  cylinders 

{(Pi,  P2,  n)  G  R3  |  Pi  +  P22  =  constant  ^  0}. 

The  surfaces  defined  by  D  —  {(Pi,  P2,  n)  |  ^  ^  =  const}  are  ellipsoids. 

From  Theorem  4.2.2  the  integral  curves  of  the  the  vector  held  — p 
are  restricted  to  a  connected  component  of  the  set  S  =  PflOrb(-),  which  in  this 
case  is  simply  S'1  (see  Fig.  (4.1)). 
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Proposition  4.2.7  The  hovercraft  dynamics  defined  by  Equation  (3.18)  are 
controllable. 

Proof:  In  (3.18)  setting  u2  =  k,  where  k  is  some  constant  not  equal  to  zero, 

the  equations  reduce  to  those  of  the  jet-puck  and  hence  from  Proposition  4.2.5 
the  dynamics  are  controllable.  ■ 

Observe  the  similar  structure  of  base  space  equations  for  the  jet-puck  and  those 
of  the  controlled  Euler  equations  for  an  axisymmetric  spacecraft  (Equation  3.22) 
with  one  control  vector.  Hence  similar  claims  regarding  controllability  can  be 
made,  (see  [Crouch,  1984;  Baillieul,  1981]  where  these  results  originally  ap¬ 
peared).  Proofs  are  omitted  as  they  are  similar  to  those  of  the  jet-puck  dynam¬ 
ics. 

Proposition  4.2.8  The  spacecraft  dynamics  of  an  axisymmetric  spacecraft  de¬ 
fined  by  (3.22)  are  controllable  if  a2  +  (32  ^  0  and  7  7^  0. 

Remark  4.2.9  The  coadjoint  orbits  in  so( 3)*  are  spheres  (see  Fig  4.2) 

{(n1; n2, n3)  e  r3  |  +  n2  +  ng  =  const}. 

In  this  case  since  the  coadjoint  orbits  are  compact  manifolds  one  can  conclude 
from  Theorem  4.2.2  that  the  drift  vector  held  is  WPPS.  Fig  (4.2)  shows  the 
intersection  of  the  coadjoint  orbits  and  the  energy  surface. 

In  the  setting  of  the  autonomous  underwater  vehicle  with  coincident  center  of 
mass  and  center  of  buoyancy  we  assume  that  the  vehicle  is  an  ellipsoid  with 
semiaxes  l\,  I2  and  I3  where  lt  lies  along  the  e\  axis.  Assuming  that  the  principal 
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Figure  4.2:  Energy  surface  and  coadjoint  orbits  in  se(2)* 


axes  of  the  vehicle  and  the  principal  axes  of  the  displaced  fluid  are  the  same  we 
have 

J  =  diag(h,  h,  h)  and  M  =  diag(mi,m2,m3)  (4.6) 

Lets  further  assume  that  that  we  have  three  controls  u \ .  u2,  u3  such  that  u  1  and 
u2  provide  pure  torques  and  u3  provides  a  pure  force.  The  reduced  dynamics  are 


IIi 

ri2 

ri3 

Pi 

p-i 

h 


12  ~  h  „  „  m2  ~  m3  „  „ 

n2n3  h - -P2P3  +  ui 

hh  rn2m3 

13  —  L  „  „  m3  —  mi  „  „ 

— Y 7 — 11311!  H - P3P1  +  u2 

hh  m3mi 

h  —  I2„  „  mi  —  m2  „  „ 

2nin2  +  ^ - -pxp2 


hh 

p2n3  T3II2 


m3m2 


(4.7) 


h 

h 

p3Ih 

Pi  n3 

h 

h 

P1H2 

P2  n. 

h 

h 

+  u3 


Proposition  4.2.10  The  Lie-Poisson  reduced  dynamics,  defined  by  (4-7),  of  the 
underwater  vehicle  with  coincident  center  of  buoyancy  and  center  of  gravity  are 
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controllable  if  I\  ^  I2. 

Proof:  Let 

. I2  —  I3 „  „  m2  —  m3  „  „  .  d  , I3  —  L  „  „  mo  -m.  9 

/  =  (JV^n2n3  +  +  (JW2n3n1  +  -p3^V 


IoL 


213 


+(^Vr^n1n2  + 


m2m3 
mi  —  m2 


an,  v  hh 


+(: 


/i/2 


/1 


777.3m! 

mim2  1  2'<9n3  I3  I2  dPi 


dUo 


n  d  . 

W2  +  ( 

P1II2 

P2W 

1  5 

h 

h 

’op-. 

d 

d 

91  ~  dW 

■,  92  = 

cdV 

93  = 

d 

dP [ 


Choose  V  =  (II,  P)  =  |(nTy4n  +  PTCP),  where  A  =  J”1  and  C  =  M_1  are 
positive  definite  symmetric  matrices.  Observing  that  V  is  radially  bounded  and 
V  =  0  along  trajectories  of  (4.7),  we  can  conclude  that  /  is  WPPS.  Further  we 
have, 

[[/,9lU]  =  hL=-M-L  Hf,g2],g 3]=  19 


hh  01V  LU,^J’*OJ  i2ap3 

[[[/.92].[/.93]].9i]  =  4fPJr 

I1I2J-2,  07  2 

Treating  vector  fields  /  and  //7s  as  coloumn  vectors  and  observing  that 


det(gi ,  5-2, 53,  [[/,  51] ,  52] ,  [[/,  52] ,  53] ,  [[[/,  52] ,  [/,  53]] ,  51] )  = 


(h  -  h 
Wih 


t^O  (4.8) 


if  Ii  7^  I2,  i.e.  dim(span£{j)91  ,S2,S3}) (p)  =  6,  \/p  G  se(3)*,  and  that  /  is  WPPS 
the  result  follows  from  Theorem  4.2.2.  ■ 


Proposition  4.2.11  The  Lie-Poisson  reduced  Hamiltonian  vector  field  ( given 
by  the  right  hand  side  of  Equation  (3.31))  defined  on  s*  is  WPPS. 

Proof:  Choose  P(II,  P,  T)  =  H(H,P,T)  +  rTr.  Observing  that  V  is  radially 
unbounded  and  that  V  =  0  along  trajectories  of  (3.31)  the  result  follows  from 
Theorem  4.2.2.  ■ 
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4.3  Small-Time  Local  Controllability 


Whereas  showing  controllability  in  systems  can  be  quite  difficult  one  can  often 
show  that  the  system  is  small-time  locally  controllable  (STLC)  [Sussmann,  1983; 
1987] 

Definition  4.3.1  The  control  system  (4.3)  is  said  to  be  small-time  locally  con¬ 
trollable  (STLC)  from  x$  G  M  if  it  is  locally  accessible  from  x0,  and  Xq  is  in  the 
interior  of  Rv (x o,  <  T)  for  all  T  >  0  and  each  neighborhood  V  of  Xo ■  If  this 
holds  for  any  Xq  E  M  then  the  system  is  called  small-time  locally  controllable. 

Let  X  =  {W0, . . .  Xm}.  Let  Br(X )  denote  the  set  of  all  possible  “brackets”  of 
elements  of  X.  Let  8i{B)  denote  the  number  of  occurrence  of  X%  in  B  E  Br(X). 
An  element  B  E  Br(X )  is  said  to  be  bad  if  S0(B)  is  odd  and  Si(B)  is  even  for  each 
i  =  1, . . . ,  m.  A  bracket  is  good  if  it  is  not  bad.  Let  Sm  denote  the  permutation 
group  on  m  symbols.  For  it  G  Sm  and  B  G  Br(X),  define  tt(B)  to  be  the  bracket 
obtained  by  fixing  X0  and  sending  Xx  to  Xn(^  for  a  =  1, . . . ,  m..  Now  define 

13(B)  =  f  (B). 

Consider  the  bijection  (j)  :  X  — >  . . . ,  gm}  which  sends  X0  to  /  and  Xt  to 

g,  for  i  =  rn  define  the  evaluation  map 

Ev{ tj})  :  C{X)  -G  C{F)  :  atXx  ^  ^  a^X  at  G  R 

i  i 

In  [Sussmann,  1987]  the  following  sufficient  condition  for  STLC  in  terms  of  the 
Lie  brackets  and  Lie  algebra  generated  by  the  the  vector  fields  {f,gi,  ■  ■  ■ ,  gm} 
was  given. 
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Theorem  4.3.2  Consider  the  bijection  tp  :  X  — »  {/,  gi, . . . ,  gm}  which  sends  X0 
to  f  and  Xi  to  for  i  =  1 .m.  Suppose  that  the  systems  (4-3)  is  such  that 
every  bad  bracket  B  e  Br(X)  has  the  property  that 

m 

Evx(rP)(/3(B))  =  Y,<*iEvM{Ci) 

i— 1 

where  Ci  are  good  brackets  in  Br(X)  of  lower  degree  than  B  and  ^  e  R,  i  = 
1, . . .  ,m.  Also  suppose  that  (4-3)  satisfies  the  LARC  at  x.  Then  (4-3)  is  STLC 
from  x. 

Hence  if  all  bad  brackets  can  be  “neutralized”  or  can  be  expressed  as  a  linear 
combination  of  good  bracket  of  a  lower  degree  then  the  system  is  STLC.  In  the 
case  of  a  single  input  system  [Sussmann,  1983]  showed  the  following  necessary 
condition  for  single  input  systems. 

Theorem  4.3.3  Consider  an  analytic  system 

x  =  f0(x)  +  fi(x)u,  \u(t)\  <  A  (4.9) 

and  a  point  Xo  such  that 

[fl,  [fo,  fl]\(x0)  i  S\fo  +  ufi,  fi)(xQ) 

where  S1(Xi,X2)  is  the  linear  span  of  X\,X2,  and  the  brackets  (adXi)3 X2  for 
j  >  1  and  u  is  such  that  /0(x0)  +ufi(x0)  =  0.  Then  (4-9)  is  not  STLC  from  x0. 

We  use  the  above  result  to  show  that  the  unreduced  jet-puck  dynamics  are  not 
STLC. 
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X 


cos  6  Pi  sin  6P2 


y 

9 


Pi 


P2 


m  m 

sin  6  Pi  cos  OP2 

m  m 

n 

7 


P2U 

I 


+  U  COS  0 


Pi  n 

1 


+  u  sin  0 


fl 


d  sin  0 


(4.10) 


Proposition  4.3.4  The  unreduced  dynamics  (4-10)  are  locally  strongly  accessi¬ 
ble  if  sin  0  7^  0. 


Proof:  Given 


Pi  cos  9  P2  sin  9  d  P2  cos  9  Pi  sin  9  N  d  II  d 

J  V  /  P  V  ^ 


m 


m  7  dx 


m 


m  dy  I  d9 


and 


.  d  .  d  .  d 

9  =  COS(/)dPi+sm^m+d  sin  0  on 


we  calculate  the  following  brackets 


6  =  [/,  g\ 

cos (6  +  f)  d  sin(#  +  0)  d  dsin0  d  (II  +  dP2)  sin  0  d 

m  dx  ^  m  dy  I  d6  I  dPi 

II  cos  (j)  +  dP\  sin  (j)  d 

+  I  W2 

6  =  [[. f,g\,g\ 

2d  sin2  1 j)  d  2d  cos  0  sin  0  d 
I  dP4  I  ap 

6  =  [/,[[/,  g],  g}\ 

2dsin0sin(0  +  6)  d  2dcos(0  +  6)  sin0  d  lid  sin  20  d 
Im  dx  Im  dy  ^  I2  dP\ 
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2Ud  sin2  <f>  d 

P  dp 

U  = 

—2d2  cos  4>  sin2  4>  d  2d2  sin3  (f>  d 

P  dp  P  ~dp 

&  =  [fi[lf,g],[[f,g],g}}} 

2d2  cos(4>  +  6)  sin2  <j>  d  2d2  sin2  f  sin(0  +  6)  d  211  d2  sin3  <f>  d 

Pm  dx  Pm  dy  P  dP\ 

2IId2  cos  (j)  sin2  (j)  d 
P  dp 

Again  treating  g  and  p's  as  colonmn  vectors,  observe  that 


det[g,  6, 6,6,  £4,  £5] 


16d8  sin8  cj) 
Pm2 


Hence  again  if  sin  (f>  0,  dim(span£{ys}.) (p)  =  6  \/p  G  T*SE( 2).  Also  [/,  X]  e 

span  (<7, £1, £2, £3, £4, £5)  VX  e  {g,PC2,p,pp5}-  Hence  the  complete  system  is 
locally  strongly  accessible.  ■ 


Proposition  4.3.5  The  unreduced  hovercraft- dynamics  dynamics  defined  (4-10) 
are  not  STL  C  from  the  origin. 

Proof:  It  is  sufficient  to  consider  STLC  of  the  reduced  dynamics  (3.17). 

With  5  =  0  observe  that  Sl(f,g)( 0)  is  a  one-dimensional  space  spanned  by 

aEp  +  Ppk.  +d@m  while  [0>  [/>#]] (°)  =  ~2lP2Wi  +  27^aafv 

Hence  \g,  [/,  g]\ (0)  f  S1  (/,  g)  (0)  ■ 

Again,  as  the  equations  of  the  axisymmetric  spacecraft  with  a  single  control 
(cf.  3.22)  are  similar  in  structure  to  those  of  the  jet  puck  we  can  make  similar 
comclusions  about  STLC. 
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Proposition  4.3.6  The  unreduced  axisymmetric  spacecraft  dynamics  defined 
(3.22)  are  not  STL  C  from  the  origin. 

The  dynamics  of  the  asymmetric  spacecraft  with  two  gas  jet  actuators  has  been 
shown  to  be  STLC  in  [Krishnan  et  al,  1992;  1994], 

We  now  study  the  STLC  of  the  underwater  vehicle  with  coincident  center  of  mass 
and  center  of  buoyancy.  Again  assuming  the  the  principal  axes  of  the  vehicle 
and  the  principal  axes  of  the  displaced  fluid  are  the  same  we  have 

J  =  diag(Ii,  I2,  h)  and  M  =  diag{mi)m2,mfi). 

The  unreduced  dynamics  on  T*G  are  given  by 


r  =  RM  lP  (4-11) 

R  =  RJ^m  (4.12) 

ri  =  nxj^n  +  PxJir'p  +  i/i  (4.13) 

P  =  Px  J-1  n  +  U2  (4.14) 

where  U\  =  (ui,«2,0)t  and  U2  =  («3,0,0)T. 


Proposition  4.3.7  The  reduced  AUV  dynamics  defined  by  (f.lS-f.lf)  are  small¬ 
time  locally  controllable  if  fi  p  I2 

Proof: 

In  Proposition  4.2.10  we  already  showed  that  the  LARC  was  satisfied.  Hence  we 
need  to  verify  that  all  bad  brackets  can  be  expressed  as  a  linear  combination  of 
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good  brackets  of  lower  degree.  One  first  observes  that  from  Theorem  4.3.2  all 
bad  brackets  are  of  odd  degree.  From  (4.8)  it  follows  that  all  brackets  of  degree  6 
or  higher  can  be  expressed  a  linear  combination  of  lower  order  brackets.  Further 
all  brackets  in  (4.8)  are  good.  Hence  we  need  to  only  check  for  brackets  of  order 
1,  3,  and  5.  The  degree  1  bracket  is  /  which  is  equal  to  0  at  the  equilibrium 
(n,  P)  =  (0,0).  The  degree  3  brackets  are  [[/,  gi\,  gi\,  i  =  1,2,3  which  are  equal 
to  0  for  all  (n,  P).  The  degree  5  brackets  can  be  broken  into  three  sets  (i) 
[[[[f,9i],9i],9i],9i],  i  =  1,2,3  which  are  again  equal  to  zero  since  [[/,&],&]  = 
0,  i  =  1,2,3,  (ii)  [[[f,9i],f\,[f,9i]],  i  =  1,2,3  and  (iii)  [[[/,&],[/,[/,&]],  i  = 
1,2,3.  The  brackets  (ii)  and  (iii)  are  equal  to  zero  at  (n,  P)  =  (0,0).  (The 
verification  was  done  using  Mathematica).  Hence  we  conclude  that  the  reduced 
dynamics  are  STLC.  ■ 

While  calculating  the  LARC  and  verifying  STLC  conditions  for  the  unreduced 
dynamics  (4.11-4.14)  of  the  autonomous  underwater  vehicle  can  be  very  tedious 
and  messy,  we  conjecture  that  the  unreduced  dynamics  are  STLC. 


4.4  Cotangent  Space  Controllability 

In  this  section  we  exploit  the  reduction  procedure  to  gain  some  insight  into  the 
controllability  properties  of  the  unreduced  dynamics.  Before  we  present  our 
results  we  recall  a  few  definitions. 

Definition  4.4.1  A  map  0  :  M  — »  N  is  called  a  proper  map  if  0_1(R)  is 
compact  for  all  compact  Vn  C  N . 
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Definition  4.4.2  An  action  $  :  G  x  M  — »  M  is  proper  if  the  mapping  <f>  : 
G  x  M  M  x  M,  defined  by  $(g,x)  =  (x,$(g,x))  is  proper 

Lemma  4.4.3  Let  G  be  a  compact  Lie  group  whose  action  $  :  G  x  M  — >  M 
on  a  manifold  M  is  free.  Let  it  :  M  — »  M/G  denote  the  projection  map.  Then 
D  =  7 r~1(-D)  is  compact  iff  D  C  M/G  is  compact  i.e.  the  projection  map  tt  is  a 
proper  map. 

Proof:  Assume  that  D  is  compact.  Since  G  is  compact  $  is  proper  (see 

previous  remark).  Hence  from  Proposition  2.1.2,  7r  is  a  smooth  submersion. 
Since  tt  is  a  smooth  submersion,  if  D  is  compact,  then  D  =  t t(D)  is  compact. 

(<=)  Now  assume  that  D  is  compact.  Let  {yk}  be  an  sequence  in  D  =  t r_1(D). 
Let  {xk}  =  {^(Vk)}-  {xk}  £  D,  and  since  D  is  compact  {xk}  has  convergent 
subsequence  {x^}  that  converges  to  x*  e  D.  Now  consider  the  subsequence 
{ykj}  such  that  ykj  G  7r_1(xfc.).  Since  {xkj}  converges  to  x*,  {ykj}  converges  to 
7r“1(x*)  i.e.  given  any  e  there  exists  N  and  {y'kj}  G  7 r”1(x*)  s.t  \\yk.  —  y'k  \\  <  e/2 
for  all  kj  >  N.  Since  G  is  compact,  7 r_1(x*)  is  compact  and  hence  there  exists  a 
convergent  subsequence  {y'k.  }  that  converges  to  some  y*  G  7 r-1(x*),  i.e.  given 
any  e  there  exists  N'  s.t.  || y'k_  —  2/*||  <  e/ 2  for  all  n*  >  N' .  Thus  there  exists 
a  subsubsequence  {ykjm}  and  N"  such  that  || ykjrn  — y'k  ||  <  e/2  and  hence 
|| yk  —  y* ||  <  e  for  all  kjm  >  N ",  i.e  the  subsubsequence  {ykjm}  converges  to 
y*  G  7T™1  (x*)  C  D.  Hence  we  conclude  that  D  is  compact.  ■ 

Theorem  4.4.4  Let  G  be  a  compact  Lie  group  whose  action  on  a  Poisson  man¬ 
ifold  M  is  free  and  proper.  A  G-invariant  Hamiltonian  vector  field  XH  defined 
on  a  manifold  M  is  WPPS  if  there  exists  a  function  V  :  M/G  —>  IR  that  is 
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proper  and  V  =  0  along  trajectories  of  the  projected  vector  field  Xg  defined  on 

M/G 

Proof:  Let  D  =  {p,  \  V(g)  <  E.  n'i/nM/G}  Then  the  integral  curve  of  Xg 

starting  at  p0  £  D,  denoted  by  (j)fH(p. o),  lies  entirely  in  D.  Since  D  is  closed 
and  bounded  in  M/G,  it  is  compact.  Let  4>fH(x 0)  be  the  integral  curve  of 
the  Hamiltonian  vector  field  Xh  starting  at  Xq ,  at  t  =  0.  At  any  given  time 
f  >  0,  (j)*H(x0 )  G  7 where  p0  =  ^(^o)-  But  4>fH(tio))  E  D,V  t  >  0. 
Hence  (j)^H(x o)  G  7 r_1(.D).  Since  D  is  compact  from  Lemma  4.4.3  7 r^1(Il)  is 
compact  and  the  integral  curve  of  the  Hamiltonian  vector  held  Xh  starting  at 
x0  is  restricted  to  the  compact  set  tt~  l(D).  To  study  the  dynamics  of  XH  through 
x0  we  restrict  ourselves  to  the  symplectic  leaf,  induced  by  the  Poisson  bracket  on 
M ,  passing  through  Xq  .  Let  E  be  the  symplectic  leaf  passing  through  Xq .  (If  the 
Poisson  bracket  on  M  is  the  Lie-Poisson  bracket  then  E  is  the  coadjoint  orbit 
through  Xo-)  The  integral  curve  f>fH(xo)  lies  entirely  in  W  =  7r_1(ld)  f'l  E,  which 
is  compact  in  E,  and  hence  as  in  the  proof  of  Theorem  4.2.2  Xh  is  WPPS.  ■ 

Again  having  concluded  WPPS  nature  of  the  Hamiltonian  vector  held,  if  the 
Hamiltonian  control  system  on  M  and  M/G  satisfy  the  LARC,  then  from  The¬ 
orem  4.1.4  controllability  can  be  concluded. 

Remark  4.4.5  See  also  result  on  controllability  on  principal  hber  bundles  with 
compact  structure  group  [Martin  and  Crouch,  1984], 

While  Theorem  4.4.4  gives  a  sufficient  condition  to  check  for  WPPS  of  drift 
vector  held  and  hence  for  controllability  of  systems  where  the  symmetry  group 
was  compact  it  is  not  of  too  much  help  in  the  noncompact  case.  In  the  present 
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setting  of  the  hovercraft  and  the  underwater  vehicles  we  observe  that  though 
SE(n),  n  =  2,3  is  not  a  compact  group,  it  is  a  semidirect  product,  i.e.  G  = 
H  xpV  where  H  =  SO(n )  is  compact  and  V  =  ]Rn  is  a  vector  space.  In  the 
setting  of  semidirect  products  one  can  make  the  following  observation  (See  [Rose, 
1978]  for  the  proof). 

Theorem  4.4.6  Let  H  act  on  V,  with  the  action  p.  Let  G  =  H  xpV .  Then 

1.  H  is  a  subgroup  of  G. 

2.  V  is  a  normal  subgroup  of  G 

3.  G/V  =  H 

Hence  if  the  dynamics  are  G  invariant  and  G  is  a  semidirect  product,  then  one 
can  perform  reduction  of  dynamics  in  two  stages.  First  by  V,  to  obtain  dynamics 
on  H  x  g*,  and  then  by  H  to  obtain  the  reduced  dynamics  on  g*.  Exploiting 
this  reduction  by  stages  we  have  the  following  controllability  result. 

Theorem  4.4.7  Let  G  =  H  xpV ,  H  compact  and  V  a  vector  space.  Then  the 
Lie-Poisson  reduced  dynamics  defined  on  T*G/G,  corresponding  to  G-invariant 
dynamics  are  controllable  iff  the  reduced  dynamics  on  H  x  T*G  are  controllable. 

Applying  these  results  to  the  examples  discussed  earlier  we  have  the  following 
results. 

Proposition  4.4.8  The  reduced  dynamics  on  SO (2)  x  se( 2)*  given  by 
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are  controllable  if  sin  (f>  7^  0. 


Pi 

Pi 

ri 


Poll 


i 

Pi  n 

i 

dsin  <f> 


+  u  cos  (j) 


u  Sill  ( 


Proof:  Let  /  =  and  g  =  (0,cosc/>,  sin</>,  dsin</>)T.  Observe 

that 

4 d5  sin5  cj) 


det {g[f,g}  [[f,g],g]  [[ f,g }  [[f,g],g]])  = 


IA 


Hence  LARC  is  satisfied  iff  sincj)  7^  0  The  proof  follows  from  Proposition  4.2.5 
Theorem  4.4.7. 


Remark  4.4.9  In  the  case  of  the  spacecraft  since  G  is  compact  one  can  now 
conclude  controllability  of  the  complete  dynamics  in  the  case  of  axisymmetric 
spacecraft  with  one  control  and  the  asymmetric  spacecraft  with  2  pure  torques. 
While  this  is  an  old  result  we  have  provided  what  we  think  as  a  more  elegant 
proof  to  the  problem  as  compared  with  that  of  [Crouch,  1984], 

Proposition  4.4.10  The  reduced  dynamics  of  the  underwater  vehi¬ 

cle  with  coincident  center  of  mass  and  center  of  buoyancy,  defined  on  SO( 3)  x 
sc(3)*  are  controllable  if  I\  7^  I2 ■ 

Proof: 

The  proof  follows  from  Proposition  4.2.10,  theorem  4.4.4  and  the  LARC.  The 
LARC  was  verified  using  Mathematica. 
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We  end  this  chapter  with  a  sufficient  condition  for  controllability  of  the  unre¬ 
duced  dynamics  defined  on  T*G  where  G  need  not  be  compact.  We  use  the 
results  of  [Lewis  and  Murray,  1996;  Lewis,  1995;  Bullo  and  Lewis,  1996]  in  the 
proof  of  our  theorem.  Here  sufficient  conditions  for  configuration  controllability 
(see  definitions  below)  of  mechanical  systems  on  a  Lie  group,  with  a  left  invariant 
Lagrangian  and  left-invariant  forces  are  presented.  The  results  presented  are  de¬ 
rived  assuming  that  the  dynamics  are  written  on  TG  as  opposed  to  T*G.  as  has 
been  the  case  in  our  work.  But  in  class  of  problems  that  we  are  considering  (see 
below  for  precise  statement  on  assumptions  of  the  class  of  mechanical  systems) 
the  two  formulations  are  equivalent  and  are  related  via  the  fiber  derivative,  or 
the  Legendre  transform.  Their  results  on  configuration  controllability  coupled 
with  our  results  on  controllability  of  reduced  dynamics  will  be  used  to  prove 
a  sufficient  condition  for  controllability  of  the  complete  (unreduced)  dynamics. 
Before  presenting  the  result  we  briefly  discuss  definitions  and  previous  result  on 
configuration  controllability  as  is  applicable  to  the  present  setting. 

Consider  a  mechanical  system,  whose  configuration  space  can  be  identified  with  a 
Lie  group  G.  Let  L  :  TG  — >•  1R  be  a  left  (G)  invariant  Lagrangian.  Let  L  :  g  — >  1R, 
be  the  restriction  of  the  Lagrangian  to  the  identity.  Let  flUi(t),  i  =  {1, . . .  ,m} 
denote  left  invariant  forces.  Let  ad^  :  g  — >  g:  r/  i— >  [£,77]  denote  the  adjoint  map 
and  ad|  denote  its  dual. 

In  terms  of  the  configuration  g  G  G  and  body  fixed  velocities  £  G  g  the  motion 
of  the  system  can  now  be  defined  by 

9  =  9-Z  (4-15) 
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Equation  4.16  is  called  the  Euler-Poincare  equation  (cf.  [Marsden  and  Scheurle, 
1993b;  1993a;  Bloch  et  al.,  ]  and  references  therein.)  The  Euler-Poincare  equa¬ 
tions  represent  the  reduced  dynamics  on  TG/G  =  g.  The  equivalence  between 
the  Euler-Poincare  and  Lie-Poisson  dynamics  can  be  seen  by  making  the  follow¬ 
ing  Legendre  transformation  for  g  to  g*. 

9  =  77,  H  =<  fi,£  >  -L(£). 


Observing  that 


s H_ St  SL  8G_ 

Sfi  ^ +  /i’  5/j)  (st'Sfj)  s 


if  follows  that  the  Euler-Poincare  equations  are  equivalent  to 


A  =  ad^/i  +  V  flUi 

s»  i= i 

where  the  drift  term  is  nothing  but  the  Lie-Poisson  reduced  dynamics  (cf.  [Mars¬ 
den  and  Ratiu,  1994]  Theorem  13.6.2).  In  the  setting  where  the  Lagrangian  is 
the  kinetic  energy  of  the  system  and  L  =  £TI£,  where  H  :  g  — >•  g*  is  the  inertia 
tensor,  (4.15-4.16)  can  be  written  as 


9  =  9t  (4-17) 

m 

=  ad  +  (4.18) 

i=  1 

Having  shown  the  equivalence  between  the  two  formulation  we  now  define  config¬ 
uration  controllability  on  (4.15-4.16),  and  present  results  by  [Lewis  and  Murray, 
1996;  Lewis,  1995;  Bullo  and  Lewis,  1996]  on  configuration  controllability  before 
we  present  our  result. 


Let  go  E  G  and  let  V  be  a  neighborhood  of  G.  Define 

RG(go,T)  =  {g  E  G  |  there  exists  an  admissible  input  u  :  [0, T]  — »  U 
such  that  the  evolution  for  (4.17-4.18)  with  initial  conditions 
g( 0)  =  go,  £(0)  =  Osatishes  g(t)  E  V,  0  <  t  <  T  and  g(T)  =  g} 


Let 

RvG(go,<T)=  U  R%(g0,t) 

0  <t<T 

Observe  that  in  the  above  dehnition  of  a  reachable  set,  the  set  of  initial  conditions 
is  restricted  to  the  set  with  zero  initial  velocity  and  further  the  final  velocity  is 
not  relevant.  Further  the  reachability  set  is  defined  in  terms  of  a  neighborhood 

V  oi  go  E  G  and  not  of  (#0,  £0)  G  TG. 

Definition  4.4.11  The  system  is  small  time  locally  configuration  controllable  at 
go  if  there  exists  a  T  >  0  such  that  go  E  int(RG(go,  <  t))  for  every  neighborhood 

V  of  g0  and  0  <  t  <  T 

Definition  4.4.12  The  system  (4.17-4.18)  is  equilibrium  controllable  if  for  any 
(#i,0),  (#2,0)  there  exist  at  T  >  0  and  an  admissible  input  u  :  [0,T]  — »  U  such 
that  the  solution  (#(£),£(£))  of  (4.17-4.18)  with  initial  conditions  (#(0),£(0))  = 
(#i,0)  satisfy  (#(T),£(T))  =  (#2,0). 

Remark  4.4.13  The  set  of  points  £  =  {(#,0)  :  #  G  G}  defines  the  set  of  all 
equilibrium  points  of  (4.17-4.18). 

Definition  4.4.14  The  symmetric  product  of  (•:•):  g  — >  G  :  £,  #  :  #)  is 

defined  as 

{£  '■  v)  =  — E_1(ad^I#  +  ad*I£)  (4.19) 
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Let  B  =  {bi, . . . ,  bm}  C  0  (a  left  invariant  distribution  on  G)  denote  the  input 
subspace.  In  the  present  setting  bi  =  I-1/*.  Let  Lieg(B)  and  SymQ(B )  denote 
the  involutive  and  symmetric  closure  of  B  in  g.  As  in  section  3.2  on  small  time 
local  controllability,  a  symmetric  product  is  bad  if  it  contains  an  even  number  of 
each  of  the  vectors  in  B.  A  symmetric  bracket  is  good  if  it  is  not  bad. 

Theorem  4.4.15  The  system  (4-17-4-18)  is 

(i)  locally  configuration  accessible  if  rank(Lieg(Symg)(B))  =  dim(G)  and 

(ii)  equilibrium  controllable  if  it  is  locally  configuration  accessible  and  if  every 
bad  symmetric  product  can  be  written  as  a  linear  combination  of  good  symmetric 
products  of  lower  degree. 

Proof:  [Lewis,  1995]  ■ 

We  now  present  a  sufficient  condition  for  controllability  of  (4.17-4.18). 

Theorem  4.4.16  If  the  dynamics  of  the  mechanical  systems  given  by  (4-17  - 
4-18)  are  such  that 

(i)  The  system  is  equilibrium  controllable,  and 

(ii)  the  reduced  dynamics  (4-18)  are  controllable, 
then  the  system  is  controllable. 

Proof:  To  show  controllability  2  we  need  to  show  that  there  exists  a  T  >  0  and 
an  admissible  control  u  :  [0,T]  — »  U  such  that  given  any  (gi,£i)  and  (<?/,£/)  the 

2  “he  euthor  thanks  Herbert  Struemper  Yor  ciscussions  In  this  croof. 
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solution  (g(t),£(t))  satisfies  (#(0),£(0))  =  (#i,£i)  and  (g(T),£(T))  =  (#/,£/). 
Using  the  properties  (i)  and  (ii)  we  construct  such  a  control. 

Assume  that  there  exists  a  (<73, 0)  such  that  there  exists  an  admissible  control  v! 
that  will  steer  the  system  from  (c/3,0)  to  (fl'/, £/).(The  existence  of  such  a  (<73,  0) 
an  u'  is  shown  later.)  The  problem  is  now  reduced  to  finding  a  control  to  steer 
the  system  form  (<71,  £1)  to  (<73,  £3)  which  is  done  as  follows. 

Let  g(t,0,go,£(t))  denote  the  the  solution  of  (4.17)  at  t  >  0  for  a  particular 
curve  £(t)  G  0  and  initial  condition  g0.  Similarly  let  £(t,  0,  £0,  £(£))  denote  the 
the  solution  of  (4.18)  at  t  >  0  for  a  particular  input  u  and  initial  condition  £0 
and  £(£,  0,  ((7o,£o),'u)  denote  the  solution  of  (4.17-4.18)  at  t  >  0  for  a  particular 
input  u  and  initial  condition  (</o,  £o)- 

1.  Since  the  reduced  dynamics  are  controllable  there  exists  a  control  U\  such 
that 

C(7i,0,  (c/i,£i),Mi)  =  (^2,0). 

2.  Since  the  dynamics  are  equilibrium  controllable  there  exists  a  control  u2  such 
that  £(^2,0,  (c/2,0), Mi)  =  (03,0). 

3.  Finally  applying  u3  we  have  £(T3,0,  (03,O),w3)  =  ( gf,xf ). 

The  existence  of  (g3,  0)  and  u3  is  shown  as  follows.  Find  w3,  such  that  £(T3,  0,  0,  M3) 
£j.  Existence  of  such  a  control  follows  from  the  reduced  space  controllability 
of  4.18.  Apply  the  control  m3  to  (4.17-4.18)  with  initial  condition  £(0)  =  0 
and  arbitrary  g(0)  =  g'3.  Then  £(T3, 0,  (g'3, 0),  m3)  =  (sq,£/)  where  gA  need 
not  be  equal  to  gf.  Let  g(t,  0,  g'3,  £(t))  denote  the  solution  to  (4.17)  where 
£(t)  =  £(f,  0,0,  m3).  Let  R  e  G.  Then  by  left  invariance  g  =  Rg(t,  0,  g3,  £(t))  is 
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a  solution  to  (4.17-4.18).  Choose  R  such  that  g(T:i)  =  Rg(T3, 0,  g'3,  £(i))  =  gf , 
i.e  R  =  gflgg  and  hence  g(t )  =  g^gggit,  0,  g'3,  £(t)).  Again  left-invariance  im¬ 
plies  that  g(T3,0,g41gfg'3,£(t))  =  gf  or  equivalently  £(T3,  0,  (gZ19f9,3,  0),%)  = 
(#/,£/).  Hence  choose  g?,  =  gf1  gjg'>  and  u'  =  u 3.  ■ 

Remark  4.4.17  Given  a  mechanical  system  with  symmetry  i.e.  G-invariant 
dynamics,  configuration  controllability  and  controllability  of  reduced  space  can 
be  verified  using  Theorem  4.4.15  and  Theorem  4.2.2. 

We  now  apply  Theorem  4.4.16  to  the  autonomous  underwater  vehicle  with  co¬ 
incident  center  of  mass  and  center  of  buoyancy. 

Proposition  4.4.18  The  unreduced  dynamics  (4-11-4-14)  °f  the  autonomous 
underwater  vehicle  with  coincident  center  of  mass  and  center  of  buoyancy,  de¬ 
fined  on  T*SE( 3)  (or  equivalently  TSEifi))  are  controllable  if  R  7^  R 

Proof:  As  shown  in  Theorem  4.4.16,  controllability  of  (4.11-4.14)  can  be 

shown  if  controllability  of  reduced  dynamics  (4.13-4.14)  and  equilibrium  con¬ 
trollability  of  (4.11-4.14)  can  be  shown.  In  Proposition  4.2.10  controllability  of 
reduced  dynamics  has  already  been  show.  We  now  show  that  the  dynamics  are 
equilibrium  controllable.  Defining  J  and  M  as  in  (4.6).  Rewriting  the  reduced 
dynamics  on  se(3)  we  have. 

O  =  r1{mxVt  + Mv  xv)R  J~lUi  (4.20) 

v  =  M~\Mv  x  ft)  +  M~1U2  (4.21) 
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Where  0  and  V  are  as  defined  in  Section  3.3,  Lfi  =  (u i,  u 2,  0)  and  U2  =  («3,  0,  0). 
Thus  the  input  space  is  spanned  by  the  vectors 


Calculating  the  symmetric  brackets  we  have 


Observing  that 

(i)  V  =  {bi,b2,  63,  (&i  :  62),  (62  :  h),  (bl  ■  {b2  ■  63))}  spans  R6  if  h  ^  I2. 

(ii)  Every  symmetric  bracket  in  T>  is  good,  and  from  (i)  every  bracket  of  degree 
4  or  higher  degree  can  be  expressed  a  combination  of  good  lower-degree  good 
brackets. 


(iii)  Every  bad  symmetric  bracket  of  degree  2  is  of  the  form  (bt  :  bi)  i  =  1,2,3 
and  is  equal  to  0, 
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It  follows  that  the  dynamics  are  equilibrium  controllable.  Hence  controllability 
follows  from  theorem  4.4.16. 


Remark  4.4.19  in  the  case  of  the  unreduced  jet-puck  dynamics  as  we  have 
only  one  input,  every  non-trivial  second-order  symmetric  bracket  is  bad.  Hence 
sufficient  conditions  for  equilibrium  controllability  are  not  satisfied  and  hence  we 
can  not  conclude  controllability  of  unreduced  dynamics.  In  [Lynch  and  Mason, 
1997]  the  problem  of  controlling  a  hovercraft  (planar  rigid  body)  is  discussed 
in  connection  with  dynamcis  prehensile  manipulation.  Here  is  it  shown,  using 
similar  ideas  that  the  unreduced  dynamcis  of  a  hovercraft  are  controllable  with 
two  unidirectional  thrusters  providing  opposite  torques. 
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Chapter  5 


Control  and  Stabilization 


Having  shown  controllability  of  the  reduced  and  in  some  case  of  the  unreduced 
dynamics  of  a  class  of  mechanical  systems  in  Chapter  4,  in  this  chapter  we  study 
the  stability,  stabilization  and  control  of  the  dynamics  of  these  systems. 

When  studying  the  class  of  mechanical  systems  discussed  in  Chapter  2,  the 
stability  of  certain  trajectories  of  the  free  dynamics  is  of  practical  interest.  For 
example  in  the  rigid  body  example,  the  stability  of  a  motion  corresponding  to 
spinning  about  a  certain  axis,  is  of  crucial  interest  in  satellite  control.  Similarly 
engineers  are  interested  in  the  stability  of  motions  corresponding  to  rotations 
and  translation  about  a  principal  axis  in  the  case  of  the  underwater  vehicle. 
These  trajectories  correspond  to  group  orbits  and  hence  project  to  equilibrium 
points  of  the  reduced  dynamics  and  are  called  relative  equilibria.  One  of  the 
main  goals  of  this  chapter  is  to  study  the  stability  and  stabilization  of  these 
relative  equilibria. 
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5.1  Stability  of  Relative  Equilibria 


Let  M  be  a  differentiable  manifold  and  G  be  a  Lie  group.  Let  :  x  K Y 
$s(x),  x  G  M,  g  G  G  denote  the  action  of  G  on  M.  Let  X  be  a  G  invari¬ 
ant  vector  field  defined  on  M. 

Definition  5.1.1  A  relative  equilibrium  of  X  is  a  point  xe  G  M  such  that  for 
some  £e  e  0  called  the  generator  of  the  relative  equilibrium,  the  curve 

t 1 — y  exp(^et)xe 

is  an  integral  curve  of  X  starting  at  xe. 

In  other  words  xe  is  a  relative  equilibrium  if  the  flow  of  X  starting  at  xe  is  an 
orbit  of  xe  corresponding  to  the  action  of  the  one-parameter  subgroup  exp{^et). 
If  G  acts  regularly  and  freely  on  M,  then  M/G  is  a  manifold  and  X  projects  to 
X  on  M/G  (c.f.  Proposition  2.1.2).  Since  the  dynamical  orbit  starting  at  xe  is  a 
group  orbit,  it  projects  to  an  equilibrium  of  the  vector  held  X.  Hence  one  may 
alternately  define  a  relative  equilibrium  as: 

Definition  5.1.2  A  point  xe  is  called  a  relative  equilibrium  of  X  iff 

X(ir(xe))  =  0, 

where  ir  :  M  — »  M/G  is  a  smooth  submersion. 

Before  we  present  any  tools  to  study  stability  of  relative  equilibria  it  becomes 
essential  to  define  stability  as  the  word  “stable  dynamics”  has  been  interpreted 
in  various  ways  in  literature.  Different  interpretations  of  stability  can  lead  to 
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different  stability  criteria.  To  avoid  any  confusion  we  present  definitions  and 
results  on  stability  of  autonomous  systems. 

Consider  the  autonomous  system 

x  —  X{x )  (5.1) 

where  x  =  ( x  \ , . . .  xn)  are  local  coordinates  for  a  smooth  manifold  M  and  X  is 
a  smooth  vector  held.  Let  xe  be  an  equilibrium  point  of  (5.1)  i.e. 

X(xe)  =  0. 

Definition  5.1.3  The  equilibrium  point  xe  is  said  to  be 


•  locally  stable  if  for  any  neighborhood  Vo  of  xe  there  exists  a  neighborhood 
V  of  xe  such  that  for  all  x(0)  =  xq  G  V  the  solution  x(i,  0,Xo)  of  (5.1) 
belongs  to  V  for  all  t  >  0.  Or  equivalently,  for  each  e  >  0 

3  6  =  5(e)  >  0,  suchthat  ||x0  —  xe\\  <  S  =>-  ||x(i,  0,  x0)  —  xe\\  <  e  Vi  >  0 

•  locally  asymptotically  stable  if  for  any  neighborhood  Vo  of  xe  there  exists 
a  neighborhood  V  of  xe  such  that  for  all  x(0)  =  Xo  6  V  the  solution 
x(i,  0,  xo)  of  (5.1)  converges  to  xe  as  t  — >  oo.  Or  equivalently,  xe  is  stable 
and 

||x(0)  —  xe ||  <  S  =>•  lim  ||x(i,  0,  xo)  —  xe||  =  0 

t— >  OO 

•  linearly  stable  if  the  linearized  equation 

Qf 

x  =  Ax  where  A  =  —  (x)  L  (5.2) 

ox 

is  locally  stable. 
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•  spectrally  stable  if  the  all  the  eigenvalues  of  A  have  non-positive  real  parts. 

Remark  5.1.4  If  all  the  eigenvalues  of  the  A  lie  in  the  open  left  half  plane 
then  the  know  that  the  linear  system  is  (5.2)  is  asymptotically  stable  and  we 
can  conclude  from  Lyapunov’s  first  method  that  the  equilibrium  point  xe  of 
(5.1)  is  locally  asymptotically  stable.  If  X(x)  is  a  conservative  system  then 
the  eigenvalues  of  the  linearized  system  are  symmetrically  distributed  under 
reflection  about  the  real  and  imaginary  axis.  Hence  in  this  setting  one  can 
conclude  spectral  stability. 

We  now  recall  Lyapunov’s  direct  method  (also  know  as  the  second  method  of 
Lyapunov)  that  allows  us  to  determine  the  stability  of  a  system  without  explicitly 
integrating  the  system. 

Theorem  5.1.5  Let  x  =  0  be  an  equilibrium  point  of  (5.1).  Let  V  :  D  — >  IR,  be 
a  continuously  differentiable  function  on  a  neighborhood  D  of  x  =  0,  such  that 

H(0)  =  0  andV{x)>  0  in  D  —  { 0}  and 

LX{V)  <0  in  D. 

Then,  xe  =  0  is  stable.  Moreover  if 

LX(V)  <0  in  D  —  {0} 
then  x  =  0  is  asymptotically  stable. 

To  study  the  stability  of  relative  equilibria,  xe  e  M  of  a  G'-invariant  vector  held, 
X  we  study  the  study  the  the  stability  of  its  projection  pe  =  7r(xe)  with  respect 
to  the  reduced  dynamics  Xj-;  defined  on  M/G. 
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Definition  5.1.6  A  relative  equilibrium  xe  €  M  of  a  vector  field  X  e  X(M) 
is  relatively  stable  modulo  G,  or  simply  stable  if  the  equilibrium  /ie  =  7r(xe)  is 
stable  with  respect  to  the  reduced  dynamics  X  e  X(M/G). 

In  the  setting  of  Lie- Poisson  reduced  dynamics  on  g*  the  autonomous  system  of 
interest  to  us,  setting  u  =  0,  takes  the  form  (c.f.  Theorem  2.1.10) 

A  =  Xg{p.)  =  A  (li)VH(p).  (5.3) 

Since  X~H  is  a  Hamiltonian  vector  field,  Lx~  (■ H )  =  XS(H)  =  [H,H]  =  0. 
Hence  H  is  trivially  a  conserved  quantity.  Lets  further  assume  that  the  null 
space  of  the  Poisson  tensor  A(-)  is  not  empty  and  is  spanned  by  the  Casimirs 
Ci(fj)  i  —  1, . . .  ,m  i.e.  A (g)VPj(g)  =  0.  Then  fie  is  an  equilibrium  of  (5.3)  if 
and  only  if 

m 

^H(ne)  —  'y  ^  AiVCj(/ie),  A*  G  1R, 

i= 1 

or 

m 

V(h-^A!VC,)W  =  0 
1=1 

Now  (5.3)  can  be  rewritten  as 

m 

\x  —  A(n)V (H  —  A*VCi)(/i) 

1=1 

Hence  it  follows  that  V (H  —  \  A* VC*)  are  conserved  quantities  along  trajec¬ 

tories  of  (5.3). 

The  Casimirs  and  the  reduced  Hamiltonian  H  can  be  exploited  to  come  up  with 
a  suitable  choice  of  a  Lyapunov  function.  This  approach  is  known  as  the  energy 
Casimir  method  [Arnold,  1969]  and  is  a  generalization  of  the  Lagrange-Dirichlet 
theorem. 
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5.1.1  Energy-Casimir  Method 


Theorem  5.1.7  If  there  exists  a  Casimir  function  C  (or  in  some  examples  a 
Casimir  plus  other  conserved  quantities)  such  that 

V(H  +  C)(ne)  =  0  (5.4) 

W2(H  +  C){  fie)  >  0,  (or  <  0)  (5.5) 

then  pie  is  a  stable  equilibrium  of  (5.3). 

Proof:  (cf.  [Wang,  1990])  Choose 

V(jM)  =  (H  +  C)(jM)-(H^C)(jie). 

By  assumption  V2(H  +  C)(fie)  is  positive-definite  and  hence  pe  is  a  strict  local 
minimum.  Thus  there  exists  a  neighborhood  U  of  pe  such  that  V (ji,-  ')  =  0  and 
V(fj,)  >0  V  /i  G  U  —  {xe}.  Further  since  H  +  C  is  a  conserved  quantity  along 
trajectories  of  the  system 

LX-(V)  =  0  \/peU-{xe}. 

Hence  from  Lyapunov’s  direct  method  it  follows  that  xe  is  a  stable  equilibrium. 


The  approach  to  study  the  stability  of  a  relative  equilibria  using  the  energy 
Casimir  method  can  be  summarized  as  follows: 

(1)  Consider  a  function  =  H  +  $((71, . . . ,  Cn)  +  $(1C, . . . ,  Kn),  where  H 
is  the  Hamiltonian,  Ci, . . . ,  Cn  are  Casimirs  such  that  VC*  span  the  null  space 
of  the  Poisson  tensor  A (//),  and  K,  are  other  conserved  quantities. 
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(2)  Choose  (I>,  VI/  such  that  has  a  critical  point  at  the  relative  equilibrium 
of  interest. 

(3)  Definiteness  of  the  second  variation  of  at  the  critical  point  is  sufficient 
for  Lyapunov  stability. 

The  energy-Casimir  method  provides  a  systematic  method  to  determine  the  sta¬ 
bility  of  the  equilibrium  of  the  reduced  dynamics.  As  an  example  application  of 
the  energy  Casimir  we  apply  it  to  study  the  the  stability  of  relative  equilibria  of 
the  jet  puck  dynamics.  Recall  that  the  jet  puck  dynamics  are  given  by 


Pi  =  P2U/I  +  au 

P2  =  -PiU/I  +  pu 
n  = 


(5.6) 


where  a  =  sin  0,  (3  =  sin  <f>  and  7  =  d  sin  r/>.  The  reduced  Hamiltonian  is  given 
by 


h  =  ^n2  + 


\\n 


(5.7) 


21  2m 

The  dynamics  (5.6)  are  Hamiltonian  with  respect  to  the  Hamiltonian  H  and  the 
Lie-Poisson  structure  on  se(2)*,  given  by 


A  = 


0  0  P2 

0  0  -Pi 

-Pi  Pi  0 


(5,8) 


The  equilibria  of  (5.6),  the  reduced  dynamics,  are  given  by  E  =  {Pi,P2,n 
Pi  =  p2  =  o}  u{Pi,P2,n|n  =  o} 
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The  Casimir  for  this  Poisson  structure  is  given  by 


C  =  P-P  =  \\P\\2  (5.9) 

where  P  =  ( Pi,P2)t .  Any  function  $(P  •  P)  is  also  a  Casimir.  Since  II  is  a 
constant  of  motion  any  function  T(II)  too  is  constant  along  flows  of  (5.6). 


We  now  study  the  stability  of  a  particular  equilibrium  //e  =  (II0,  0,0),  II0  ^  0. 
Choose 

H*'V  =  H  +  V(P-P)  +  V(  n)  (5.10) 

The  first  variation  is  given  by 


DH*,9(6n,  8PU  SP2 )  =  (y  +  ^'(n))  •  8U  +  (^  +  $'(P  •  P)2Pl)  •  8PX 


{—  +  $'(P  •  P)2P2)  •  SP2 

m 


where 


T/  dT 

*  =M  md 


= 


<9$ 


0(P  •  P) 


Now  (PT$^)  |Me=  0  implies 


n° 

T^II)  =  — — ,  and  $7(0)  can  be  chosen  arbitrarily 


The  second  variation  D2H^>  ^  evaluated  at  /re  is 

i  +  ^"(n°)  0  0 

0  A  +  2$'(0)  0 


0 


0 


i  +  2*'(0) 


Definiteness  of  the  second  variation  implies 

1 


+  T"(n°)  >  o, 
(I  +  ^(n°))(l  +  2$'(o))  >  o, 


m 


(-  +  T',(n°))(— +  2$"(0))2  >  0 

I  m 


(5.11) 


(5,12) 


(5,13) 


(5,14) 
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We  can  obviously  choose  to  satisfy  (5.12)  and  (5.14).  For  example  choose 
4/  =  and  $  =  0.  Hence  we  can  conclude  that  (n°,  0,  0)  is  a  stable  relative 
equilibrium. 

We  now  study  the  stability  of  the  equilibrium  pe  =  (0,  P2°).  Again  (. DH $;^)  \^e 

0  implies 

'F'(n)  =  0,  and  $'(P°  ■  P°)  =  (5.15) 

m 

The  second  variation  D2H $ evaluated  at  //e  =  (0,  P{J,  P2°)  is 

i  +  T'(0)  0  0 

0  4$"(P°  •  P°)(P10)2  4$"(P°  •  P°)(P1°P20) 

0  4$',(p°  .  P°)(P10P2°)  4$"(p0  .  P°)(P10)2 

Since  det (D2H$^)  |(o,po,p2°)  =  0,  it  implies  that  the  second  variation  is  semideh- 
nite  and  the  energy  Casimir  method  in  this  case  is  inconclusive  in  determining 
the  stability  of  the  equilibrium  point  /xe  =  (0,  P°,  P2 ). 

One  can  conclude  that  /je  =  (0,  P”,  P2°)  is  in  fact  an  unstable  equilibrium  by 
explicitly  integrating  the  vector  field.  To  infer  instability  we  look  at  the  projec¬ 
tion  of  the  solution  of  (5.6),  with  initial  conditions  (IT,  Pi,  P2)  in  a  neighborhood 
of  [if. .  in  the  P1P2  plane.  The  solution  is  that  of  a  harmonic  oscillator  with 
frequency  fl.  Hence  in  the  P1P2  plane  the  vector  (Pj ,  P7)7  is  rotated  with  fre¬ 
quency  if.  Hence  given  a  sufficiently  small  neighborhood  of  //f, ,  Pi(t),  P‘A,t)  leave 
this  neighborhood  in  hnite  time  (and  hence  unstable),  although  they  return  to 
it  after  time  t  = 

The  stability  of  underwater  vehicle  with  coincident  and  non  coincident  center 
of  mass  and  center  of  buoyancy,  using  the  energy-Casimir  method,  have  been 


(5.16) 
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studied  in  [Leonard,  1995]  and  we  refer  the  reader  to  it  for  details. 

5.2  Hamiltonian  Feedback  Control 

To  stabilize  relative  equilibria  using  feedback  control  various  approaches  have 
been  adopted.  In  [Bloch  et  al,  1992a;  Bloch  and  Marsden,  1990;  Leonard,  1996] 
feedback  laws  have  been  chosen  such  that  the  closed  loop  system  is  still  Hamilto¬ 
nian  with  respect  to  Poisson  structure  defined  on  the  quotient  manifold.  We  refer 
to  these  controls  as  Hamiltonian  feedback  control’s.  In  this  section  we  discuss 
the  existence  and  a  few  example  of  Hamiltonian  feedback  controls  for  the  me¬ 
chanical  systems  discussed  in  earlier  chapters.  We  then  use  the  energy- Casimir 
method  to  study  stability  of  the  closed  loop  systems. 

Proposition  5.2.1  There  does  not  exist  a  feedback  control  u  =  £(Pi,  P2,  n)  such 
that  the  closed  loop  system  (3.17)  is  Hamiltonian  with  respect  to  the  Lie  Poisson 
structure  defined  on  sc( 2)*. 

Proof:  Lets  assume  that  there  exists  a  feedback  law  u  =  f(Pi,  P2,  n)  7^  0 

such  that  the  closed  loop  system  is  Hamiltonian  with  respect  to  the  Lie-Poisson 
tensor 

0  0  P2 

A  =  0  0  -Pi 

— P2  Pi  0 
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This  implies  that  there  exists  a  function  4/  ( I\ .  P2,  hi)  such  that 

0  0  P2 


u  = 


a 

P 

7 

(5.17) 


(5.18)  and  (5.19) 


0  0  -Pi 

-P2  Pi  0 


d^> 

dPi 

a ^ 
0P2 

av 

an 

(5.17) 


which  is  a  contradiction. 


<9T 

a£(Pi,P2,II)  =  P2— , 

(5.18) 

<9T 

fc(Pl,P2:n)  =  -P  , 

(5.19) 

<94>  <94/ 

7f(Pi,P2,n)  P2dPl  1  PldP2 

(5.20) 

<94>  P>  P 

7m  -  +  W  =0  V  Pl’P2 
all  a  (3 

(5.21) 

94/ 

M(Pl,P2,il)  =  0 

(5.22) 

£(Pi,  P2,  n)  =  0  since  a,  (3  ^  0 

(5.23) 

■ 

Remark  5.2.2  See  the  following  section  for  examples  of  dissipative  control  laws 
to  stabilize  relative  equilibria. 

The  case  of  stabilizing  the  rigid  body  relative  equilibria  has  been  studied  in  some 
detail  and  we  refer  the  reader  to  [Bloch  et  al,  1992a;  Bloch  and  Marsden,  1990] 
for  further  details  and  references. 

We  now  consider  the  stabilization  of  the  underwater  vehicle  dynamics  with  three 
pure  torques  (cf.  [Leonard,  1996])  using  dissipative  feedback.  The  dynamics  of 
the  underwater  vehicle  are  given  by 


ri  =  nxr'n  +  PxJir'p  +  i/  (5.24) 
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P  =  P  x  J-1  n  (5.25) 

where  U  =  (iq,  112,  us)T  (c.f.  Section  3.3.4).  Let  us  assume  that  the  underwater 
vehicle  is  approximated  by  an  ellipsoid.  There  are  three  sets  of  two-parameter 
families  of  equilibrium  solutions  (with  tq  =  0)  each  family  corresponding  to  a 
constant  translation  along  and  rotation  about  one  principal  axes  of  the  vehicle. 

In  the  rest  of  the  discussion  we  study  stability  the  equilibrium  solution  xe  = 

(n°,p°)  =  (o,o,n°,o,o,p30),p30  ^  o.  1 

Given  a  function 

4>  :  Rn  x  Rm  x  Rp  — »  R;  (x,  y,  z )  (->•  (j>{x,  y,  z ) 

‘et  VA  =  (£,  •  •  •  Similarly  let  =  (£,-•  and  =  (ft,  •  •  •  J|)T 

Proposition  5.2.3  Under  the  feedback  law  U  =  P  x  Vpd/(Pi,  P2,  P3)  £he  closed 
loop  system  ( 5.24-5.25 )  is  Hamiltonian,  with  respect  to  the  Hamiltonian  H  +  T 
and  the  minus  Lie-Poisson  bracket  defined  on  se( 3)*.  Further  an  unstable  relative 
equilibrium  xe  =  (0,  0,  n3,  0,  0,  P3 )  can  be  stabilized  using  a  linear  feedback  law 
aP°  x  P. 

Proof:  Let  us  assume  there  exist  feedback  controls  defined  by 

Ul  =  ti(n,p),  «2  =  6(n,P)  «3  =  &(n,P) 

such  that  the  closed  loop  system  (5.24-5.25)  is  Hamiltonian  with  respect  to  the 
Lie-Poisson  structure 

n  P 

Mu)  =  A(H,P)  =  ^ 

P  0 

1  Pq  =  0  corresponds  eo  e  uon  eeneric  yquilibrium  coint,  e.e.  e  coint  e  which  ehe  essociated 
Poisson  eensor  noses  lank 


106 


defined  on  se(3)*.  This  implies  that  there  exists  a  function  T(II,P)  such  that 

(5.26) 


u 

= 

n  p 

Vn4/ 

0 

p  0 

VpT 

(5.26)  implies  that  T  has  to  satisfy  the  PDE 

P  x  Vn  =  0 

Any  T(II,  P )  of  the  form 

T(n  ,P)  =  Ti(P)  +  n-p 


(5.27) 


(5.28) 


satishes  (5.27).  Further  since  II  •  P  is  a  Casimir  it  is  constant  along  flows  and 
does  not  contribute  to  the  dynamics.  Hence  choosing  T  =  T  |  (P)  the  given 
feedback  control  follows  from  (5.26) 


In  [Lamb,  1945;  Leonard,  1995]  it  was  shown  that  for  an  ellipsoidal  neutrally 
buoyant  vehicle  with  coincident  center  of  mass  and  center  of  buoyancy  and  e\ 
axis  of  symmetry,  constant  (nonzero)  translation  along  and  rotation  about  the 
e|  axis  is  stable  if 

,n2.9  11  , 

W  (5'29) 

Otherwise  it  is  unstable.  Hence  if  the  vehicle  was  a  prolate  spheroid,  i.e.  1 3  >  l\ 

n° 

then  m3  <  mi  and  the  relative  equilibrium  can  be  unstable  for  a  small  -pfa 
ratio.  Now  let  us  assume  that  n[],  P3  is  such  that  the  relative  equilibrium  is 
unstable.  Proposition5.2.3  suggests  that  an  unstable  relative  equilibrium  xe  = 
(0,  0,  II3 , 0,  0,  P3)  can  be  stabilized  using  a  linear  feedback  law  aP°  x  P3. 


An  application  of  the  energy-Casimir  method  to  study  the  stability  of  xe  with 
this  feedback  law  shows  that  the  equilibrium  is  stable  if 

#2>4/4-i  +  a)'  (530) 
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Hence  a  can  be  chose  to  satisfy  (5.30)  and  make  the  equilibrium  stable.  ■ 

In  the  setting  of  the  underwater  vehicle  with  noncoincident  center  of  mass  and 
center  of  buoyancy  we  can  make  a  similar  observation. 

Proposition  5.2.4  Under  the  feedback  law  U  =  Px  VpT(P,  T)  +  Tx  Vr^-P,  T) 
where  tPi (-) ,  T2(-)  are  smooth  functions,  the  closed  loop  system  (3.31)  is  Hamil¬ 
tonian  with  respect  to  the  Hamiltonian  H+^(P,Y)  and  the  Lie  Poisson  structure 
defined  on  s* . 

Remark  5.2.5  As  in  the  previous  setting  a  linear  feedback  law  of  the  form 

U  =  a-P  +  P-T,  a  =  (aq,^,  «3)T,  P  =  {Pi,  P2,  Psf  (5.31) 

makes  the  closed  loop  system  in  Hamiltonian.  The  vectors  a  and  P  can  be  chosen 
such  that  closed  loop  system  has  the  desired  motion  of  interest  as  the  relative 
equilibrium  of  the  closed  loop  system.  This  approach  is  adopted  in  [Leonard, 
1996]  to  find  a  feedback  law  to  stabilize  the  underwater  vehicle  about  any  desired 
Pe,  Te  with  no  spin,  i.e.  fle  =  0. 

5.3  Dissipative  Feedback  Control 

In  this  section  we  present  a  constructive  approach  to  stabilize  relative  equilibria 
of  Hamiltonian  systems  using  dissipative  control  laws.  We  define  a  control  law 
to  be  dissipative  if  the  divergence  of  the  closed  loop  system  is  less  than  zero.  The 
approach  exploits  the  existence  of  a  center  manifold  of  the  reduced  dynamics. 
We  first  present  related  results  on  center  manifolds. 
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Consider  a  system  of  the  form 

y  =  My  +  gi{y,z) 

z  =  A2z  +  g2(y,z ) 


where 


0i(O,O)=O;  ^(0,0)  =  0  ^(0,0)  =  0  i  =  1,2 


(5.32) 

(5.33) 


Further  assume  that  all  the  eigenvalues  of  A  t  are  equal  to  zero  and  the  eigenvalues 
of  A2  he  in  the  open  left  half  plane. 


Definition  5.3.1  A  smooth  invariant  manifold  of  the  form  z  =  h(y)  is  called  a 
center  manifold  if 

r)h 

h( 0)  =  0  and  — (0)  =  0. 
dy 

We  now  state  the  center  manifold  theorem  and  related  results.  Details,  proofs 
and  historical  references  can  be  found  in  [Carr,  1981]. 

Theorem  5.3.2  (Center  Manifold  Theorem)  If  g±  and  g2  are  twice  continu¬ 
ously  differentiable,  all  eigenvalues  of  A\  have  zero  real  parts  and  all  eigenvalues 
of  A2  have  negative  real  parts,  then  there  exists  S  >  0  and  a  continuously  differ¬ 
entiable  function  h(y),  defined  for  all  ||y||  <  6,  such  that  z  =  h(y)  is  a  center 
manifold  for  (5.32-5.33).  Further  the  motion  of  the  system  on  the  center  mani¬ 
fold  is  described  by 

y  =  Aiy  +  gi(y,  h{y))  (5.34) 

Theorem  5.3.3  (Reduction  Principle)  Under  the  assumptions  of  Theorem 
5.3.2, 
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(i)  if  the  origin  y  =  0  of  (5.3 f)  is  asymptotically  stable,  (unstable),  then  the  origin 
of  (5.32-5.33)  is  also  asymptotically  stable  (unstable). 

(ii)  Suppose  the  origin  y  =  0  of  (5.32)  is  stable.  Let  ( y(t),z(t ))  be  a  solution  of 
(5.32-5.33)  with  (y(0),  z(0))  sufficiently  small.  Then  there  exists  a  solution  y(t ) 
of  (5.32)  such  that  as  t  — »  oo, 


y(t)  =  y(t)  +  0(e  7t ) 

(5.35) 

z(t)  =  h(y(t ))  +  0(e'7t) 

(5.36) 

As  we  shall  now  see  center  manifolds  occur  naturally  in  the  reduced  dynamics 
of  G-invariant  Hamiltonian  dynamics. 

Recall  that  the  reduced  dynamics  of  g*  are  given  by 

A  =  VgU)  =  A  (g)VS(g),  (5.37) 

where  p  G  0*  and  H  is  the  reduced  Hamiltonian. 

Let  pe  be  an  equilibrium  point  of  Xg,  i.e.  Xg(pe)  =  0.  Let  us  assume  that  there 
exists  a  neighborhood  V  of  pe  such  that,  in  this  neighborhood  the  Poisson  tensor 
A(/x)  has  constant  rank  m,  m  <  n  where  n  is  the  dimension  of  g*.  (Recall  that 
m  is  even).  From  the  symplectic  stratification  theorem  (c.f.  Theorem  2.1.6)  V 
is  foliated  by  symplectic  leaves  of  dimension  m.  Hence  there  exist  coordinates  2 
(w\, . . .  wm,  Si, . . .  Sn-m )  in  the  neighborhood  V,  of  pe,  such  that  each  leaf  of  the 
foliation  is  given  by  the  submanifold 

Hai ...an-m  =  e  g*  |  s.  =  au  i  =  f) . . .  n  -  m}  (5.38) 

2Sxistence  If  ehese  coordinates  Yollows  Yrorn  ehe  Frobenius  eheorem. 
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where  each  a*  is  a  constant  such  that  at  e  (— e*,e).  Hence  the  foliation  S  is 
given  by  the  collection  of  all  submanifolds  (5.38)  parameterized  by  a*,  1 1 a* 1 1  <  e, 
i  =  1, . . .  n  —  m,  i.e. 

E  =  (J  S®!'"®"-™,  i  =  1, . . .  n  —  m.  (5.39) 

We  shall  assume  without  loss  of  generality  that  the  leaf  containing  fie  is  given 
by 

s°e  =  it*  €  0*  I  =  °>  *  =  1,  •  •  •  n  -  m} 


Hamiltonian  dynamics  on  g*  restricts  to  canonical  Hamiltonian  dynamics  on  each 
leaf.  Hence  the  coordinates  (w,  s )  can  be  chosen  with  w  =  (qi, . . .  ,qi,Pi, .  ■  -  Pi) 
2 1  =  m  such  that  these  coordinates  satisfy  canonical  bracket  relations  { q j,  q:) }  = 
{Pi,Pj}  =  {/h,  Sj}  =  {Pj,Sj}  =  Is*,  s/}  =  0  and  {qt,Pj}  =  8).  (cf.  [Weinstein, 
1983a]).  Hence  in  these  coordinates  (5.37)  are  given  by 


q 

o, 

I 

0 

9H(q,p,s) 

dq 

p 

= 

-I 

0 

0 

8H(q,p,s) 

dp 

s 

0 

0 

0 

9H{q,p,s ) 
ds 

(5.40) 


H  is  H  expressed  in  these  coordinates. 

Hence  the  equilibrium  points  of  dynamics  in  this  neighborhood  are  given  by 

(5.41) 


C  u  \\  dH(q,p,s)  dH(q,p,s)  . 

£  =  {{P,  q,  s )  |  77- =  0, — =  0} 


dq  dp 

The  set  £  is  not  empty,  because  we  have  assumed  V  to  be  a  neighborhood  of 
and  equilibrium  point  //,,,  but  is  in  fact  an  immersed  submanifold  of  dimension 
r  <  n.  We  call  £  the  equilibrium  submanifold.  The  above  discussion  can  be 
summarized  in  the  following  theorem 
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Theorem  5.3.4  Let  ye  be  an  equilibrium  point  of  (5.37)  such  that  there  exists 
a  neighborhood  V  of  ye  s.t.  the  Poisson  tensor  A(y)  has  constant  rank  in  this 
neighborhood.  Then  in  V  there  exists  an  immersed  submanifold  £  such  that  for 
all  p,  G  £,  Xg(fj)  =  0.  Further  locally  there  exist  coordinates  (yi, . . .  ,yr,  z i,  zn-r) 
such  that  z  =  0  on  £ 

Th  existence  of  (y,  z)  coordinates  follows  from  the  fact  that  £  is  an  immersed 
submanifold. 

The  existence  of  such  an  equilibrium  submanifold  provides  for  a  systematic  ap¬ 
proach  to  design  a  class  of  controls  to  locally  stabilize  ye  G  £  based  on  techniques 
from  linear  system  theory  and  the  Center  Manifold  Theorem. 

Let  us  assume  that  a  nonlinear  control  system 

m 

X  =  f(x)  +  E  gi(x)ui  x  G  M  (5-42) 

i 

has  an  equilibrium  submanifold  £  of  dimension  k,  i.e  f(x 0)  =  0,  \/x0  G  £. 

Choose  coordinates  (y,  z)  in  a  neighborhood  V  of  Xq  such  that  z  =  0  on  £. 

Hence  in  these  coordinates  Xq  =  (ijq,  0).  Rewriting  (5.42)  in  these  coordinates, 
we  have 

m 

y  =  f\y,z)  +  ^g\{y,z)ui  (5.43) 

i= 1 
m 

Z  =  f2{y,z)  +  ^2g((y,z)ui  (5.44) 

i= 1 

or  equivalently  as 

m  m 

V  =  Aiy  +  Alz+:^2b1iui  +  f1(y,z)  +  ^2g1(y,z)ui  (5.45) 

i— 1  i= 1 
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where 


z  = 


Ajy  +  A\z  +  ^  }?%ut  +  /2(y,  2)  +  y2(y,  z)«i 


i=l 


i= 1 


„i  _  Wsh*)  ,  „i  _  ^/1(2/,^)  , 

^1  a_.  I  (2/0,0) )  A2  Qy  I  (s/0 jO) 


dy 

2  _  df2(y,  z) 


M  = 


dy 


l(2/o,0)>  -^2 


2  _df2(y,z) 


dy 


I  (2/0,0) 


(5.46) 

(5.47) 


Bl  =  \b\  -  ■  ■  bl 

B2  =  [%■■■% 


r  dgl 
[d(y,z) 

r  dg 2 


<9.9" 


%,a) 

dym 


%,a)  %,  a) 


(2/0,0) 


(2/0,0) 


Since  £  =  {(y,  z)  |  z  =  0}  is  an  equilibrium  manifold, 

f\y,  0)  =  0  and  /2(y,  0)  =  0,  Vy. 

Hence  Z1  and  / 2  cannot  be  linear  in  y  and 

Wy,*) 


4  = 


I  (2/0,0)—  0 


2  df2(y,z) 


M  = 


I  (2/0,0) 


(5.48) 


dy  lu/0,u;  1  dy 

Alternatively  observe  that  since  £  is  an  equilibrium  manifold  ^7  |(y0j0)  has  k 

eigenvalues  corresponding  to  eigenvectors  V\,...Vk  that  span  Txo£. 


Hence  (5.42)  can  be  written  as 

m  m 

V  =  A lz  +  f1(y,z) +  ^2b}ui  +  ^2'g1(y,z)u1 

i= 1  i=l 

m  m 

z  +  f2(y,z)  +  ^2b2ui+^2'g2(y,z)u1 


z  = 


(5.49) 

(5.50) 


i= 1 


i= 1 


We  refer  to  (5.50)  as  the  transverse  dynamics. 
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Theorem  5.3.5  Under  the  assumption  that  (5.f2)  has  an  equilibrium  subman¬ 
ifold  8 ,  there  exists  a  class  of  state  feedback  laws  u\(x)  =  K\z  +  < fi\(z ),  with 
4>\{0)  =  0,  such  that  (y0, 0)  e  8,  y0  f  0  is  a  stable  equilibrium  of  the  closed  loop 
system  if  the  linearized  transverse  dynamics  (5.50)  are  stabilizable.  Further,  for 
all  trajectories  ( y[t),z(t ))  of  the  closed  closed  loop  system  sufficiently  close  to 
the  origin 

( y[t ),  z(t))  — >  (c,  0)  as  t  — *  oo 

Proof:  Since  the  pair  {A2,  B2}  is  stabilizable,  choose  U(x )  =  Kz  +  4>(z ),  such 
that  the  eigenvalues  (A*)  of  A2  +  B2K  are  in  the  open  left  half  plane.  The  closed 
loop  system  is 

m 

y  =  Alz  +  B1Kz  +  f\y,z)  +  ^2'gl(y,z)(l)i(z)  (5.51) 

i 

m 

z  =  (A22  +  B2K)z  +  J2(y,z)  +  ^g2(y,z)(j)i(z).  (5.52) 

i 

Let  Af  =  (Al|  +  B2K).  The  change  of  variables 

V  =  V  ~  {A\  +  B1K)Aj1z 

z  =  z 

transforms  (5.49-5.50)  into 

i)  =  Nfy,z) 
z  =  AfZ  +  N2(y,  z) 

where 

m 

Ni  (y,z)  =  /1(y,  z)  +  ^^9i(y,  z)f)i{z) 


(5.53) 

(5.54) 

(5.55) 
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~{A\  +  B1K)Af1(f2(y,z)  +  Y^&Ky,z)(t)i(z))  (5.56) 

i 

m 

(y,z)  =  f2(y,z)  +  Y^gf(y,z)<j>i(z).  (5.57) 

i 

substituting  appropriately  for  y  =  y  +  (A\  +  B1K)Aj1z.  Note  that  (yo,  0)  is 
still  an  equilibrium  of  (5.53-5.54).  These  equations  are  now  in  the  setting  of  the 
center  manifold  theorem  with  z  =  0  defining  the  center  manifold.  The  reduced 
dynamics  are  given  by 

y  =  0  (5.58) 

since  /1(|/o;0)  =  0,  and  0(0)  =  0.  Hence  from  Theorem  5.3.3  we  conclude 
that  the  equilibrium  (y0,  0)  is  a  locally  stable  equilibrium  of  the  closed  loop 

system.  Since  there  exists  a  K  such  that  the  eigenvalues  of  (Af  +  B2K )  can  be 

placed  anywhere  in  the  open  left  half  plane,  we  have  a  whole  class  of  controls 
u\(x)  =  K\z  +  4>\(z),  parameterized  by  the  choice  of  A.  <f>\(z)  may  be  chosen  to 
increase  the  region  of  attraction. 

We  also  know  from  the  Theorem  5.3.3  that  if  ( y(t),z(t ))  is  a  solution  of  (5.53- 
5.54)  with  (y(0),z(0))  sufficiently  small  then  there  exists  a  solution  p(t)  of  the 
reduced  dynamics  such  that  as  t  — >  oo, 


y(t)  =  p(t )  +  0(e  7t) 

(5.59) 

z(t)  =  h(p(t ))  +  0(e'7t) 

(5.60) 

where  7  =  h(y)  defines  the  center  manifold.  In  our  setting  from  (10)  we  can 
conclude  that  as  t  — >  oo,  (y(t),  z(t ))  — »  (po,  0)  for  some  constant  p0,  i.e  the  closed 
loop  system  is  asymptotically  stable  in  z  and  stable  in  y.  ■ 

Alternatively  one  could  use  a  Lyapunov  argument  (cf.  Khalil)  to  prove  stabil- 
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ity  of  (yo,0).  In  the  rest  of  the  discussion  we  shall  assume  that  the  following 
coordinate  changes  has  been  made 

y  =  2/  —  2/0  (5.61) 

z  =  z  (5.62) 

Since  N\  and  N2  are  twice  continuously  differentiable  and 

QN- 

Ni(y,  0)  =  0;  -^(j/o,0)  =  0 

for  i  —  1,2,  in  the  domain  Bp  =  {y,z\  || (y,z)  —  (?/0,0)||2  <  p}  N1:N2  satisfy 

\\Ni(y,z)\\2  <  ki\\z\\,  i  =  1,2. 

We  also  have  ||y||  <  k  <  p  in  this  domain.  Now  consider 

V(y,z)  =  -y2  +  V'P'Pz 

Zi 

where  P  is  the  solution  to  the  Lyapunov  equation 

PA  +  AtP  =  -I. 


Since  A  is  a  Hurwitz  matrix,  a  unique  positive  dehnite  solution  to  the  Lyapunov 
equation  exists.  The  derivative  of  V (y,  z)  along  trajectories  of  the  system  (5.53- 
5.54)  is  given  by 


in - \  ~Ar  s  ,  INI  ,  z^PN2{y,z) 

V{y,z)  =  yN1{y,z)+  ^ — =  + 


< 


VzA'Pz  VzA'Pz 

1  ,  1 


z\\  ~ 


4^A  m.aX{P)  maX(P) 


1  r  k2  Xmax  \P)  \  ||~| 

—  kk  1 - .  )  \\z\ 

V^min(P) 


We  can  choose  p  sufficiently  small  such  that 

1 


4\/A  max(P) 


-  ^  _  hXmaxjP)  >  Q 
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Hence 


1 


V(y,  z)  < 


4  \J  A  m.ax{P) 


and  we  can  conclude  that  V (y,  z)  is  negative  semidefinite  and  hence  the  system 
is  stable.  Since  V  is  radially  unbounded  there  exists  a  c  such  that  the  set 
h2c  =  {y,  z\  V(y,  x)  <  c}  C  Bp  is  positively  invariant.  V  =  0  in  the  set  £  =  {y,  z  \ 
z  =  ()}.  Since  any  point  in  £  is  an  equilibrium  point,  £  is  an  invariant  set  and  we 
can  conclude  from  LaSalles  invariance  principle  that  every  trajectory  starting  in 
h2c  approaches  E  as  t  — >  oo. 


Remark  5.3.6  It  was  only  recently  that  the  author  became  aware  (c.f.  [Zenkov 
et  al. ,  ])  that  ideas  similar  to  those  used  in  the  proof  of  5.3.5  were  originally 
due  to  Lyapunov  and  Malkin  [Lyapunov,  1992;  Malkin,  1938].  In  [Zenkov  et 
al. ,  ]  stability  of  relative  equilibria  of  nonholonomic  systems  using  the  combined 
methods  of  the  energy-momentum  method,  the  Lyapunov-Malkin  Theorem  and 
the  center  manifold  theorem  are  used. 


5.3.1  Examples 

Using  the  approach  discussed  in  the  earlier  we  find  linear  feedback  laws  to  sta¬ 
bilize  relative  equilibria  of  some  of  the  examples  discussed  in  Chapter  3. 


Proposition  5.3.7  :  The  class  of  feedback  laws,  parametrized  by  Ai,A2  given 
by 


AiA2  /(A1  +  A2)  AiA2/H\  ,  x  .  n 

uxlM  =  -pp^2  -  ( - - - +  -po^)n>  Ai-  A2  >  0 

stabilize  the  equilibrium  (0,P1°,0)  of  (5.6)  for  any  P)  7^  0 


(5.63) 
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Proof: 


Observe  that  E  =  {Pi,.P2,n  |  P2  =  II  =  0}  is  an  equilibrium 
submanifold  of  se(2)*.  Make  the  change  of  coordinates 

Vi  —  P  —  Pi  zx  =  P2,  z2  =  n  (5.64) 


such  that  the  equilibrium  (0,  Pf,  0)  is  shifted  to  the  origin  in  these  coordinates. 
The  dynamics  in  these  coordinates  are 

2:1^2 

Vi  =  —j~  +  au 

zx  =  +  —I  +  [3u  (5.65) 

I  z2 

z2  =  7  u 


Linearizing  (5.65)  about  the  origin  results  in 


0  0  0 

a 

A 

0 

0 

i 

B  = 

P 

000 

7 

Using  the  notation  of  Theorem  5.3.5  we  have 


A  = 

0 

1 

^14 

B2  = 

P 

0  0 

7 

The  eigenvalues  of  A\  are  equal  to  zero.  Observe  that 


rank^1,  A\B\  =  rank 


7  0 


0. 


(5.66) 


(5.67) 


Hence  the  pair  {Af,  B2}  is  controllable  and  hence  stabilizable.  It  can  now  easily 
be  verified  that  with  u  =  Kz  =  —Z\  +  ^j-z2  where 

m  x  I  * 


A1A2  ml 


and  a2 


I 

7 


((Ai  +  A2)  + 


(5\i\2 


1 
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the  eigenvalues  of  Af  =  ( A 2  +  B2K )  are  — Ai  and  — A2.  The  rest  of  the  proof 
follows  from  Theorem  5.3.5. 


Remark:  (i)  If  P(  <  0  then  the  divergence  of  the  closed  loop  system  is  less  than 
zero  for  any  choice  of  Ai,  A2  >  0,  making  the  closed  loop  system  dissipative. 

(ii)  If  P°  >  0  then  Ai ,  A2  >  0  can  be  chosen  such  that  the  closed  loop  system  is 
dissipative. 


Proposition  5.3.8  ;  The  class  of  feedback  laws,  parametrized  by  A3,A2  given 
by 

_  AlA2  /(Al  +  A2)  AlA2/3J.  .  .  ,rCn\ 

u\iM  ~  po/1  (  ^  po^  )^’  Ai,A2>0  (5.68) 

stabilize  the  equilibrium  (0,P2°,0)  of  (5.6)  for  any  P2°  h  0 


Figures  5.1,  5.2,  show  the  trajectories  of  the  closed  loop  system,  with  stabilizing 
feedback  laws.  In  these  plots  the  relative  equillibrium  (2,0,0)  is  being  stabilized. 
Tha  values  for  Ai  and  A2  were  chosen  to  be  —0.1. 


We  now  construct  linear  feedback  law  to  stabilize  unstable  relative  equilibria  of 


the  underwater  vehicle  with  coincident  center  of  mass  and  center  of  buoyancy. 
Recall  that  the  reduced  dynamics  derived  in  of  the  AUV  with  coincident  center 


of  mass  and  center  of  buoyancy  are  given  by 


•  I2  —  I3  „  „  mo  —  m3 

rii  =  — r~? — n2n3  h - P2P3  +  ui 


PI: 


213 


m2m3 


•  I3  —  I\  „  „  7n3  —  rri\ 

n2  =  t  7  n3ni  h — - p3Pi  +  «2 


hh 


m5mi 


■  /l-hrr  TT  mi  —  m2  „  „ 

n3  =  — rt t — n1n2  h - P1P2  +  u3 


hh 


mim2 


(5.69) 
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p2n3  p3n2 


A 


A 

A 


h 

h 

p3  ni 

AIR 

h 

h 

AIR 

AIR 

h 

h 

We  now  stabilize  equilibrium  solution  xe  =  (0,  0,  n°,  0,  0,  P° ),  P3  k  0  assuming 
that  m3  <  rrq.  Recall  that  this  is  an  unstable  relative  equilibria. 


Proposition  5.3.9  There  exists  a  class  of  state  feedback  laws  of  the  form  Ui  = 
YjI  aizi  +  <f>i(z),  4>i{ 0)  =  0,  where  z  =  (zi, . . .  z5)  =  (IR,  n2,  II3,  Pi,  P2)  such  that 
the  equilibrium  xe  =  (0,  0,  0,  II3,  0,  P3 ),  P°  k  0  is  a  locally  stable  equilibrium  of 
the  closed  loop  system  (5.69). 


Proof:  We  consider  the  case  with  II3  =  0.  The  case  with  II3  7^  0  can  be  proved 
in  a  similar  way.  Observe  that  xe  G  £  =  {IR,  II2,  II3P1,  P2,  P3  |  IR  =  II2  =  Px  = 
P2  =  0}.  E  is  a  submanifold  of  se(3)*.  Linearizing  (5.69)  about  (0,  0,  0,  0,  0,  P° ) 
we  have 


A 

rti 

IR 

ii3 

A 

A 


0 


0 

0 

0 

0 

m2— m3  pO 
77727773  3 

IR 

1 

0 

0 

0 

0 

0 

m2— m3  pO 

IR 

0 

1 

0 

0 

0 

0 

0 

0 

n3 

+ 

0 

0 

1 

0 

1 

0 

0 

0 

Pi 

0 

0 

0 

p% 

h 

0 

0 

0 

0 

P2 

's. 

0 

0 

0 

A2  B2 


U 1 
U2 
U3 


Observe  that  { A2,B 2}  is  controllable  if  P3  7^  0.  Hence  there  exists  a  feedback 
law  Kz  such  that  the  eigenvalues  of  A2  +  B2K  are  in  the  open  left  half  plane. 
The  result  then  follows  from  5.3.5  ■ 
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Figure  5.5:  Stabilizing  dissipative  feedback  laws  for  the  AUV 

Figure  5.3  shows  that  the  relative  equillibria  (0,  0,  0,  0,  0, 1)  is  unstable.  Figures 
5.4  and  5.5  show  the  trajectories  of  the  closed  loop  systems  under  Hamiltonian 
and  Dissipative  feedback  laws,  respectively. 

We  conclude  this  chapter  with  some  comments  on  the  stabilization  of  the  origin 
of  the  unreduced  dynamcis  of  the  systems  studied  in  this  dissertation. 


5.4  Comments  on  the  Stabilization  of  the  Unre¬ 
duced  Dynamics 

The  existence  of  smooth  state  feedback  laws  to  stabilize  the  origin  of  control¬ 
lable/reachable  nonlinear  systems  has  been  been  studied  for  some  time  by  [Brock- 
ett,  1983].  While  Brockett’s  condition  can  easily  be  verified  for  systems  without 
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drift,  for  systems  with  drift  it  becomes  more  difficult.  Work  in  [Sontag,  1988; 
Byrnes  and  Isidori,  1991;  Aeyeles,  1985]  in  the  attitude  control  of  spacecraft  dy¬ 
namics  has  led  to  some  general  theorems  on  the  existence  of  smooth  feedback 
laws  to  stabilize  the  origin  of  a  class  of  systems  with  drift.  Using  the  results  of 
Byrnes  and  Isidori,  in  this  section  we  can  conclude  that  there  does  not  exist  a 
feedback  law  that  can  stabilize  the  origin  of  the  complete  dynamics  of  the  hov¬ 
ercraft  and  underwater  vehicle.  We  state  without  proof  the  theorem  by  Brynes 
and  Isidori. 


Consider  a  class  of  nonlinear  control  systems  of  the  form 
x2  =  f2{xi,x2),  x2  e  IT2 

m 

X\  =  fl(xi,x2)x1  +  ^2  Mi,  Ui  G  xl,he  Rni 


i= 1 


Assume  that  : 


(HI)  The  drift  vector  held 


/(®)  = 


^  h{x)xi  ^ 


V 


h{x) 


x  = 


1 


AC 

V12/ 


e  R 


n\+ri2 


is  in  C°°  and  has  0  as  an  equilibrium 


(H2)  f2(x i,x2)  =  0  implies  x\  =  0  and 
(H3)  the  Jacobian  matrix  |^-(0)  has  rank  n2. 


Let  m!  =  dim  span{A,  •  •  •  bm}. 


(5.70) 

(5.71) 


Theorem  5.4.1  Consider  a  system  (21)  satisfying  (Hl)-(HS).  There  is  a  con¬ 
tinuously  differentiable  feedback  law,  Ui  =  Ffx),  rendering  the  origin  locally 
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asymptotically  stable  iff  m!  =  rq. 


Observing  that  the  hovercraft  and  underwater  vehicles  dynamics  are  of  the  form 
(5.70)  and  satisfy  (HI)  -  (H3)  we  have  the  following  propositions: 

Proposition  5.4.2  The  origin  of  the  Hovercraft  dynamics  defined  by  (4-10) 
cannot  be  locally  asymptotically  stabilized  using  continuously  differentiable  static 
or  dynamic  state  feedback. 

Proposition  5.4.3  The  origin  of  the  Underwater  vehicle  defined  by  (4-11-4-14) 
cannot  be  locally  asymptotically  stabilized  using  a  continuously  differentiable  static 
or  dynamic  state  feedback. 

This  suggests  that  time  varying  feedback  laws  are  required  to  stabilize  the  origin 
of  thr  unreduced  dynamics.  The  study  of  designing  time  varying  feedback  laws 
to  stabilize  the  origin  is  an  area  of  current  reserach.  Some  preliminar  results  on 
the  design  of  such  feedback  laws  can  be  found  in  [Morin  et  al. ,  1995;  Pettersen 
and  Egeland,  1996b;  1996a;  Coron,  1992;  M’Closkey  and  Murray,  1993].  Open 
loop  control  strategies  are  also  being  investigated  in  [Bullo  and  Leonard,  1997] 
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Chapter  6 


Conclusion  and  Future  Research 


In  this  dissertation  issues  related  to  controllability  and  stabilization  of  a  class  of 
underactuated  mechanical  systems  was  studied.  For  the  class  of  systems  studied, 
the  configuration  space  could  be  identified  with  a  Lie  group,  G.  In  addition 
the  existence  of  a  symmetry  group  permitted  the  dropping  of  the  dynamics  to 
a  lower  dimensional  space.  The  research  was  motivated  by  issues  related  to 
the  controllability  of  hovercraft,  spacecraft  and  underwater  vehicles  in  the  case 
of  actuator  failures.  The  results  presented  relied  on  a  geometric  approach  to 
the  study  of  mechanical  systems.  A  non-canonical  Hamiltonian  formulation, 
modeling  these  systems  on  Poisson  manifolds,  was  adopted. 

In  Chapter  2  a  review  of  some  basic  mathematical  tools  including  definitions, 
notations  and  important  theorems  that  were  used  in  the  following  chapters  was 
presented.  A  description  of  Hamiltonian  systems  on  Poisson  manifolds,  the  role 
of  symmetries  and  Lie-Poisson  reduction  was  discussed  in  some  detail.  The 
notion  of  a  Hamiltonian  control  system  was  presented.  The  main  difference  in  our 
definition  as  compared  to  the  ones  presented  earlier  in  literature  is  that  we  do  not 
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require  the  control  vector  field  to  be  Hamiltonian.  To  obtain  reduced  dynamics 
we  simply  require  that  it  be  a  G-invariant  vector  field,  where  G  is  the  symmetry 
group  of  the  Hamiltonian  corresponding  to  the  drift  vector  field.  Reduction  and 
reconstruction  of  dynamics  from  the  reduced  system  is  discussed.  The  chapter 
finally  concludes  with  a  discussion  on  accessibility  and  controllability  of  affine 
nonlinear  control  systems. 

In  Chapter  3  the  reduced  dynamics  of  four  mechanical  systems,  hovercraft,  space¬ 
craft,  underwater  vehicles  and  surface  vessels  were  derived.  The  hovercraft  was 
modeled  as  a  planar  rigid  body  with  a  vectored  thrust.  The  state  space  was  iden¬ 
tified  with  the  Lie  group  SE( 2).  The  invariance  of  the  dynamics  on  T*SE(2 )  to 
the  SE( 2)  action  was  exploited  to  derive  the  reduced  dynamics  on  se( 2)*.  For 
the  spacecraft  the  configuration  space  was  identified  with  the  SO( 3)  and  the  re¬ 
duced  dynamics  on  T*SO(3)/ SO(3)  =  so( 3)*  were  derived.  For  the  underwater 
vehicle  the  configuration  space  is  identified  with  SE{3).  The  underwater  vehicle 
is  modeled  as  a  completely  submerged  rigid  body  in  an  inviscid,  incompressible, 
irrotational  fluid  of  infinite  volume.  To  derive  the  reduced  dynamics,  two  cases 
were  considered,  coincident  and  noncoincident  center  of  mass  and  center  of  buoy¬ 
ancy.  In  the  case  of  the  coincident  center  of  mass  and  center  of  buoyancy,  the 
invariance  of  the  dynamics  to  the  SE{3)  action  is  exploited  to  reduce  the  dy¬ 
namics  from  a  twelve  dimensional  space  to  a  six  dimensional  one,  namely  se(3)*. 
In  the  case  of  noncoincident  center  of  mass  and  center  of  buoyancy  symmetry  is 
broken  by  the  force  due  to  gravity  and  the  dynamics  are  invariant  to  the  sub¬ 
group  SE(2)  x  H.  In  this  setting  the  dynamics  were  reduced  to  a  system  evolving 
on  a  nine  dimensional  space,  5*,  the  dual  of  the  Lie  algebra  of  the  semidirect 
product  SE(3 )  xp  1R3.  The  chapter  concludes  with  the  study  of  motions  of  a 


127 


floating  bodies  in  quite  water  without  consideration  of  resistance  forces. 

The  main  contribution  of  this  dissertation  lies  in  Chapter  4  and  Chapter  5.  In 
Chapter  4  we  present  sufficient  conditions  for  controllability  of  the  reduced  and 
unreduced  dynamics  of  mechanical  systems  with  symmetry.  We  exploited  the 
Hamiltonian  structure  of  the  reduced  dynamics,  geometry  of  the  reduced  space, 
the  existence  of  a  Lyapunov  type  functions  and  Poincare  recurrence  theorem 
to  conclude  weak  positive  Poisson  stability  of  the  Lie-Poisson  reduced  vector 
held.  The  weak  positive  Poisson  stability  of  the  drift  vector  held  along  with 
the  Lie  algebra  rank  condition  was  used  to  conclude  controllability.  The  role  of 
the  Hamiltonian  and  Casimirs  in  deriving  the  Lyapunov  function  was  discussed. 
To  determine  controllability  of  the  unreduced  dynamics  two  separate  cases  were 
considered.  The  hrst  case  is  where  the  symmetry  group  is  compact.  Here  the 
compactness  of  the  orbits  under  the  action  of  the  group  along  with  the  weak 
positive  poisson  structure  of  the  reduced  dynamics  was  again  used  to  conclude 
controllability.  In  the  noncompact  case  we  showed  that  under  additional  con¬ 
ditions  of  equilibrium  controllability,  controllability  of  the  unreduced  dynamics 
can  be  concluded.  These  results  were  then  applied  to  examples  discussed  in 
Chapter  3  making  appropriate  conclusions  about  controllability  in  each  case. 
We  also  presented  results  on  small  time  controllability  for  these  examples. 

In  Chapter  5  stabilization  of  relative  equilibria  of  mechanical  systems  with  sym¬ 
metry  was  discussed.  Stabilization  using  “Hamiltonian”  feedback  laws  was  dis¬ 
cussed.  We  then  presented  a  constructive  approach  to  design  dissipative  feedback 
laws  using  centermanifold  theorem  like  techniques.  The  approach  exploited  the 
observation  that  the  relative  equilibria,  or  equivalently  the  fixed  points  of  the 
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reduced  dynamics,  belonged  locally  to  an  embedded  equilibrium  manifold.  We 
then  showed  that  as  opposed  to  obtaining  stable  (in  the  sense  of  Lyapunov)  so¬ 
lutions  using  Hamiltonian  feedback  laws,  our  approach  guarantees  asymptotic 
convergence  in  the  directions  transverse  to  the  center  manifold,  and  stability  in 
directions  along  the  center  manifold. 

There  are  several  directions  for  future  research  related  to  the  work  presented  in 
this  dissertation.  One  of  them  is  to  design  a  constructive  open  loop  control  strat¬ 
egy  to  steer  the  unreduced  system.  Except  in  special  cases  where  the  unforced 
dynamics  can  be  explicitly  integrated,  the  weak  positive  Poisson  stability  does 
not  offer  much  insight  into  the  design  of  controllers.  But  since  we  know  that 
the  system  is  controllable  one  can  possibly  formulate  optimal  control  problems 
which  may  provide  more  insight  about  feasible  controllers.  In  addition  one  could 
also  attempt  to  use  periodic  controls  in  the  base  space,  and  thereby  steer  in  the 
fiber. 

Another  promising  direction  is  in  showing  global  stability  of  the  closed  loop 
system  under  the  dissipative  feedback  laws  designed  in  Chapter  5.  Since  the 
divergence  of  the  closed  loop  system  is  less  than  zero  and  we  were  able  to  show 
that  the  trajectories  converge  to  the  stable  manifold  (“attractor”)  one  might 
conjecture  that  under  assumptions  of  boundedness  of  solutions  and  absence  of 
limit  cycles  the  closed  loop  system  is  globally  stable.  Analytical  results  for  the 
examples  discussed  did  seem  to  indicate  this.  Current  research  includes  efforts 
in  this  direction. 

In  addition  current  and  future  research  includes  design  of  hybrid  control  laws 
and  architectures  for  the  generation  of  behaviors  for  obstacle  avoidance  and  path 
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planning  for  the  hovercraft  and  autonomous  underwater  vehicle. 
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